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1. SUMMARY AND CONCLUSIONS 


1.1 PURPOSE, SCOPE, BRIEF SUMMARY 

The long-range objeotlve of the Automated Mixed Trafflo Vehicle 
(AMTV) program la to develop the aenslng and logic required to 
operate a low-speed, drlverleas shuttle bua or tram In mixed 
traffic, and to demonstrate operation of suoh a system In a user 
environment. 

The objective of the task included In thlfi report la to develop a 
microprocessor controller for the AMTV and evaluate its 
performance on the experimental JPL AMTV. 

The use of a mloroprooessor-based speed controller has provided 
the AMTV with a very flexible means of controlling speed, 
acceleration, and Jerk. In addition, a number of safety-related 
system checks are provided and back-up systems are used when 
needed. 


1.2 MICROPROCESSOR CONTROLLER HARDWARE 

The system chosen for this task was based on the popular 8-bit Z- 
80 microprocessor. The bus system chosen to support this 
processor was the "Standard Bus," also known as the "STD Bus." 

Basically, the microprocessor controller consists of a single 
microprocessor card with on-board RAM and ROM memory, two 
specially designed and fabricated digital tachometer Interface 
oards, one 8-port Transistor to Transistor Logic (TTL) 
Input/output card, one card capable of 16 channels of analog-to- 
dlgital conversion at Its Input and 2 channels of dlgital-to- 
analog conversion at its output, and one specially designed card 
(named the "keep-alive" card) to monitor the health of the 
microprocessor system Itself. All six cards were housed within a 
single 16 card STD Bus card-cage. The card-cage (Including bus) 
and all cards except the two tachometer cards and the keep-alive 
card are standard commercial products. 


1.3 MICROPROCESSOR CONTROLLER SOFTWARE 

Based on a set of vehicle response criteria a set of control 
algorithms (described in Section 3.2) were generated. From these 
algorithms, a computer program was written using FORTRAN as the 
programming language. This program consists of a main program 
which calls upon 11 subroutine programs for specialized functions 
and calculations. 
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1.4 SOFTWARE DEVELOPMENT SYSTEM 


All microprocessors (indeed, all digital computers) execute a 
series of instructions (termed a "program") each of which at its 
basic level is nothing more than a series of zeros and ones, 
i.e., binary numbers. Instructions stored in this form are termed 
"machine language" instructions. For applications like the AMTV 
controller, these instructions are stored in permanent memory 
modules oalled programmable read only memories (PROMs). 

Although inexpensive Instruments exist which allow one to program 
a PROM by hand by entering the binary numbers one-by-one, this 
process is very tedious, time consuming, and prone to errors. A 
far better solution is to allow a computer to Interpret high 
level instructions into machine language instructions. A computer 
along with the necessary software to accomplish this is termed a 
Microprocessor Development System. 

The system used for this task is based upon the same Z-80 
microprocessor and STD Bus as the vehicle controller. The 
software development system consisted of the the following 
hardware: one microprocessor card, four RAM boards with 16k byte3 
each, one dual serial interface card (for video terminal and 
hard-copy printer), and one floppy disk controller card. In 
addition to these cards, all of the specialized input/output 
cards described in Section 1.2 above were used for vehicle 
interface testing. 

This system stores and reads its files from "floppy" disk drive 
units. Access to the computer is accomplished using a 
combination video terminal and keyboard. Hardcopy output is via 
a dot matrix printer. Erasable Programmable Read Only Memories 
(EPROMs) are programmed via a specially constructed programmer 
connected to a standard I/O card. 

The software development system uses the popular Control Program 
for Microprocessor (CP/M) disk operating system, FORTRAN compiler 
and linker, specialized programs for EPROM programming and 
checking, and a powerful editor/word processor. 


1.5 VEHICLE PERFORMANCE 

The present performance of the AMTV meets all of the generated 
specifications, as listed in Reference 1, pertaining to 
acceleration and jerk limits. Acceleration and deceleration have 
been subjectively described by most passengers as smooth. Speed 
control is accurate within approximately .12 km/h (.08 mph). 
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As presently configured, the vehicle features three fixed 
deceleration rates and one variable rate. The fixed rates are 
adjusted for non-obstaole-oaused stops (approximately 0.09 g), 
obstaole oaused stops (about 0.16 g), and emergency stop using 
hydraulic brakes only (unmeasured g level). The stop which 
features a variable deceleration is brought about when the 
vehiole detects an obstacle In its secondary sensors and is 
traveling at a velooity greater than ^.7 km/h (2.9 mi/h,. In 
this case the necessary deceleration tootop within 2 m is 
calculated and the motor is commanded to plug at an ever 
increasing ourrent until this deceleration is reaohed. 

Accurate stops at passenger piok-up points have been attained 
regardless of vehiole speed prior to obtaining the command to 
stop. This is done by first commanding the vehicle to attain 3*2 
kra/h and then commanding a stop when the vehiole has passed 2.6 m 
beyond the magnetio street marker. 


1.6 VEHICLE SAFETY 

The employment of a mioroprocessor-based controller has afforded 
the opportunity to provide a number of safety features not 
previously used. Firafc, taohometer (speedometer) integrity is 
easily tested by providing two taohometers and comparing their 
values. An emergency stop occurs if either or both tachometers 
malfunction. Second, more flexible stopping algorithms have been 
created which allow for safe stops in the case of an intrusion 
into the path of the vehiole too dose for a normal stop, or if 
the primary sensor misses an obstaole. Third, hydraulic braking 
system malfunctions which result in the vehicle not remaining in 
a stationary position at passenger stops are deteoted and the 
motor is used as a backup system to hold the vehiole stationary. 
Fourth, overspeed or rolling baokwards runaway conditions are 
detected and the vehicle is brought bo an emergency stop. Fifth, 
failure of the microprocessor controller to properly oyole 
through its program is detected by a speoial circuit and the 
vehicle is brought to an emergency stop. Last, an automotive 
horn has been interfaced to the microprocessor and is presently 
programmed to honk briefly just before the vehicle begins to 
move. 


1.7 SOLID STATE MOTOR CONTROLLER 

A new motor controller has been successfully used on this vehicle 
to control motor ourrent. It features a transistor chopper 
circuit which limits current to the motor to some maximum value, 
and has the advantage over the SCR type chopper controller of not 
needing a by-pass relay for the last increment of ourrent. This 
allows for far smoother, quieter speed control due to the lack of 


time delay and hysteresis* Additionally, this motor controller 
features SC R-oon trolled motor field polarity change. This 
feature allows for extremely rapid and quiet ohange from forward 
to reverse motor torque (plugging) for botii aoourate speed 
control and stopping* 
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2. INTRODUCTION 


2.1 PURPOSE 

The purpose of this report Is to document the design of a 
microprocessor speed oontroller for the AMTV vehlole and the 
vehicle performance whloh resulted. 


2.2 BACKGROUND 

The AHTV concept has been described ‘in earlier papers (References 
1, 2, and 3). Basioally, It offers a cost-effeotive alternative 
to conventional busses or other transportation modes for many 
applications requiring frequent, low- speed servloe, since both 
the cost for a driver on eaoh vehicle and the large Investment 
required for exclusive guideway oonstruotlon can be avoided. 

A feasibility demonstration of an AMTV, using what was basically 
a breadboard vehicle was conducted at JPL during eary 1976. 
Results from this experiment are reported in Reference 3. The 
experiment used a wire-following steering system patterned after 
work of Fenton and Olson at Ohio State University (References H 
and 5). Similar techniques have been used by a number of 
Investigators, and reliable speeds of 50 mph have been 
demonstrated (References 6 and 7). The sensors used for 
collision avoidance wore developed at the JPL. 

Although the JPL vehicle Is a small electrio tram, any type of 
vehicle could be Incorporated Into a future AMTV system, with the 
size and type of vehlole being determined by the service 
requirements of the specific application. A number of guideway 
systems employing automated vehicles have reoently been put into 
service. Requirements of these vehicles are quite similar to 
those of an AMTV, exoept for the provision for oolllsion- 
avoidar.ee (headway) sensing, and the steering mechanization. 




2.3 SCOPE 


The scope of this task Included developing a microprocessor 
controller for the AMTV and evaluating its performance on the 
experimental JPL AMTV. The task provides for the microprocessor 
oontroller hardware and software design for the speed oontrol 
function only. The task also included replacing the SCR chopper 
motor controller with a new all-solid-state transistor chopper 
motor oontroller. 
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2.4 ORGANIZATION OF REPORT 


Seotion 1 provides a brief background and summary of the entire 
report. Seotion 2, the present section, more sharply defines the 
purpose, background, scope, and organization of the report. 
Section 3 offers a detailed specification of the on-vehicle 
microprocessor controller. Section 4 not only gives detailed 
specifications of the microprocessor development system, but also 
supplies information concerning the need for and use of the 
development system software. Section 5 describes the hardware 
and performance of the new all-solid-state motor controller. 
Section 6 describes the vehicle performance under microprocessor 
control. This is largely done using speed versus time curves 
obtained from the tachometers via the microprocessor during 
street testing. Section 7 details the safety aspects of the new 
microprocessor controller. Section 8 contains the findings and 
recommendations which have resulted from this task. Appendix A 
contains the speed control algorithms in flow-chart form. 
Appendix B contains the complete FORTRAN program listings while 
Appendix C contains new failure analysis material, which 
supplements the earlier failure mode and hazard analysis 
(Reference 1). 



3. MICROPROCESSOR SYSTEM DESCRIPTION 


3.1 ON-VEHICLE MICROPROCESSOR 

The on-vehicle microprocessor consists of a card rack with built- 
in bus system and six plug-in cards. Additionally, there are 
ancillary pieces of equipment such as power supply and LED 
display panel drivers. These components are described below, and 
where noted, in more detail, in the appendices. Figure 3*1 shows 
the above described processor, while Figure 3-2 shows the same 
processor in its housing. Figure 3-3 shows a diagram of this 
system. 

A Standard Bus (STD Bus) is used because of its size, 
flexibility, the variety of different types of commercially 
available cards, and the number of different manufacturers to 
ohoose from. This bus system is based on a 56 pin edge connector 
card of 11.4 cm by 16.5 cm (4.5 by 6.5 in.). It is designed for 
use with 8 bit microprocessors of the 6800, 8085, and Z-80 
family. The card cage used on the AMTV (Prolog No. CR16) has 
spaces for 16 cards. 

The microprocessor, Central Processing Unit, (CPU), chosen was 
the Zilog Z-80 because of its ability to use a more sophisticated 
set of software instructions. The card containing the Z-80 
(Prolog Corp. No. 7803) also has sockets for 8192 bytes of 
programmable read only memory (PROM) or erasable, programmable, 
read only memory (EPROM). In addition, this card has sockets for 
4096 bytes of random access memory. The card has its own crystal- 
controlled 400 ns clock and provision for pushbutton reset. All 
integrated circuits are socketed, and therefore easily replaced. 

As installed with the current software this card is populated 
with three EPROMs (type 2716, 2048 bytes each) and 8 RAM chips 
(type 2114, 4096 bytes) of which only about 300 bytes are used. 

To interface the central processing card to TTL compatible input- 
output (1/0) signals on the vehicle* a (Prolog No. 7604) universal 
TTL I/O card is used. This card has eight 8-bit ports, any number 
of which can function as either input or output ports, l.e., 7 in 
and 1 out or 4 in and 4 out, etc. We have modified this card for 
noise suppression by placing .01 microfarad capacitors across 
each input line. The present configuration of this card uses the 
first four ports (0 through 3) for input signals and the last 
four ports (4 through 7) for output signals. Each port is 
directly software addressable. Although several output signals 
from this card directly control vehicle function through relays 
or valves, others are used strictly to light LED indicators 
mounted on a panel above the computer. For the later purpose 
LED, driver cards were specially designed and built since the 
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FIGURE 3-1. MICROPROCESSOR CONTROLLER SYSTEM. Dark rectangular object on left is 
voltage inverter. To the right of this is the standard bus card-cage complete with 
all controller cards. Standing upright behind standard bus card cage are LED 
driver cards. The top of the case housing the controller battery is visible in 
lower right portion of photograph. 
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Prolog 7604 does not have the our rent output oapaolty to drive a 
LED. TTL I/O cards are now on the market which are able to drive 
LEDs direotly. For reliability and compactness this will be the 
oard of choioe for future units. 

To input or output analog signals to the CPU, an analog I/O oard 
(Analog Devloes No. RTI-1225) is used. This oard has the 
oapaolty to input up to 16 analog input signals using its 
multiplexer through a 10 bit analog-to-digital converter (A/D). 
The RTI-1225 can also convert an 6 bit integer to an analog 
voltage available at its output terminals. There are two such 
channels for digital-to-analog (D/A) conversion (DAC). This card 
uses memory mapping instead of direct addressing. At the present 
time no A/D channels are being used. One D/A channel is used to 
output an analog motor control voltage to control motor current. 
It is anticipated that the A/D converter on this card may be used 
for future monitoring of motor current and other analog sensor 
outputs. 

Two other cards (identical) within the microprocessor controller 
not only Interface the two digital tachometers to the STD Bus but 
actually provide the basic timing cycle for initiating repetitive 
execution of the software. These cards were designed and built 
at the JPL and are referred to as taoh cards. Each card works 
independently of the other and contains two 16 bit accumulators 
and one output register* Each 16 bit accumulator counts for 20 
ms then holds its value for 20 ms. This is an alternating 
process; one accumulator holds while the other counts up for 20 
ms, then the registers reverse roles. At the end of each 20 ms 
period the accumulator which has just finished counting has its 
data transferred to the output register. In this manner no data 
is lost while a register is being read. These cards each read 
the clock line on the STD Bus (2.54 mhz) and divide it down in 
order to create an acourate 20 ms flag. It is this flag which 
triggers the program to cycle through again. Counter- timer cards 
are now commercially available which may supply the same 
function as our specially designed oards. Because these new 
cards use printed circuits instead of the wire-wrap type circuits 
on our cards they are more reliable, economical, and far more 
compact. We hope to adapt them to our purpose in future 
controllers. 

Another card, our "keep-alive" circuit, uses the standard bus as 
a mounting rack and power supply but uses no other bus lines. 
This circuit reads a line carrying a short pulse with a 20 ms 
period which is generated by the oomputer program and output from 
the TTL 1/0 card. This circuit card contains logic and a relay 
to bring the AMTV to an emergency stop should the keep-alive 
pulse disappear for more than 4 cycles or stay permanently on for 
4 cycles. This disappearance would result from a central 
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processor failure, a taoh. oard failure, or even a previously 
undetected software error which would send the program counter to 
an improper part of program memory. 

To oontrol an automotive type electric (12V) horn, a speoial 
interface oard was designed whioh uses an optical ooupler and 
amplifier circuit to energize a horn relay which in turn 
energizes the horn. This card is not presently mounted in the 
STD Bus rack. 

The power supply for the STD bus (and all of the cards therein) 
oonsists of a 12 V to +5 V chopper type converter (Bikor model 
1202) fed from a 12 V lead acid battery. The converter draws 

4.2 A from the battery to supply the STD Bus. The cooling fan 
described below draws an additional .4 A from the battery. At 
this energy consumption rate the battery could be expected to 
supply energy for up to 20 hours. 

All of the above components except for the battery are housed in 
an aluminum based and roofed, plywood walled enclosure. 
Ventlllation of this enclosure is forced by a 12 V "muffin- type" 
fan . 

3.2 VEHICLE RESPONSE CRITERIA 

Before control algorithms can be constructed one must have a 
table of desired vehicle responses based on various Inputs. The 
table used for this task is shown in Table 3-1* 

3.3 ON-VEHICLE MICROPROCESSOR: CONTROL ALGORITHMS 

We will define ap algorithm as a method used to calculate an 
answer or product given a set of inputs. For the AMTV the control 
algorithm is broken down into one main algorithm and 11 
specialized sub-algorithms. Each of the sub-algorithms has a 
specialized control function, and as each is needed it is called 
upon by the main algorithm to perform its function. This scheme 
makes it easier to understand the overall control and provides a 
logical and convenient framework for software development. 
Figure 3-4 shows the flow or block diagram for the main 
algorithm. A similar diagram is shown in Appendix A for each of 
the sub-algorithms. In all of these diagrams the somewhat 
elliptically-shaped outlines signify entrance and exit points, 
the rectangular outlines indicate a computational function, and 
the diamond shaped outlines are rhetorical. To fully understand 
the logic of these algorithms would require some understanding of 
the characteristics of all of the vehicle's sensors and its motor 
controller. Section 5 of this report describes the motor 
controller characteristics while References 1 and 2 describe the 
vehicle's sensor characteristics. Additionally, the FORTRAN 
software listings contained in Appendix B contain many comment 
statements which explain the logic of the control scheme used. 
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TABLE 3-1. VEHICLE PERFORMANCE DESIGN 
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3.4 ON- VEHICLE MICROPROCESSOR - - SOFTWARE 

The eotual on-vehicle software consists of Z-80 machine language 
recorded on EPROMs. This code was generated from FORTRAN source 
oode by use of a FORTRAN compiler and linker resident In the 
development system described In Seotlon 4. Although the program 
Itself resides on EPROM ohlps the memory variables are plaoed 
Into RAM and modified there by the program. 


H 


a 


3-9 







INPUT/ OUTPUT 
TTL AND ANALOG 
i (DATAIOI i 

T 

READ DIGITAL 
TACH'S 
(TACHRD) 


SET FLAGS 
CFLGSET) 


emergencv\y§L 

STOP / 


DETERMINE 
NEW CONTROL 
VELOCITY (CTRLV) 

CHECK FOR 
OVERSPEED OR 
ROLL-BACK DIST 
(RUNWAY) 


TURN OFF MOTOR 
APPLY HYDR BRAKES 
EMSTPR 


EMERGENCY 

STOP / 


H » 


TIMED STOP 
ON NOW 




GOING TOO 
FAST 


DECELERATE 

(DECEL) 


A W E 


FIGURE 3-4. AMTV ft? CONTROLLER PROGRAM MAIN PROGRAM 


iliGlNAL PAGE 
• OMALITY 











4. SOFTWARE DEVELOPMENT SYSTEM 


4,1 HARDWARE DESCRIPTION 

The ©n-vehicle oomputer programs exist on EPROMs in machine 
language form. Although relatively inexpensive Instruments exist 
which allow one to program an EPROM by hand, entering the binary 
numbers one-by-one, this prooess is very tedious, time consuming, 
and prone to errors. A far better solution is to allow a 
oomputer to interpret high level instructions into machine 
language instructions, then using appropriate software and 
hardware automatically load these instructions onto an EPROM, An 
appropriate computer, along with the necessary software to 
aooompllsh this, is termed a Microprocessor Development System* 

The development system used for this task is based upon the same 
2-80 microprocessor and STD Bus used for the on-vehiole 
controller. This system is shown dlagrammatioally in Figure 4-1 
and a photograph of the system is shown in Figure 4-2. The 
development system consists of the following hardware: one 2-80 
based microprocessor card (Prolog #7803)? four RAM boards with 
approximately 16k bytes of static RAM each (each board Is a 
Prolog #7701), one dual serial interface oard (Micro/Sys #SB8420) 
for communications between microprocessor and video terminal and 
hard-copy printer, and one floppy disk ccntsoller oard (Mlcro/Sya 
#SB8500) for communication between the microprocessor and the 
floppy dick drives. In addition to these cards, for vehicle 
Interface purposes during our initial testing phase, all of the 
specialized input/output cards described in Seotion 1.2 above 
were Used. 

This system stores and reads its files from three floppy disk 
drive units (Shugart #800-2). These drives use the popular 8 in. 
diameter, flexible plastic, iron oxide coated discs. These discs 
are produced by several manufacturers and for our system are IBM 
3740 compatible, single-density, single-sided, and soft seotored. 
Each disc has a storage capacity of 256 k bytes. 

The development system described above, along with a good deal of 
software described in Seotion 4,2, was supplied as a "turn-key" 
paokage by MICRO/SYS in La Canada, California. 

Programmer aooess to the oomputer is accomplished using a 
combination video terminal and keyboard (Soroc Model IQ 120) 
operated at a rate of 19*2 k BAUD (or about 1920 characters per 
seoond maximum). Hardcopy output is via dot matrix printer 
(Teletype Model 43) operated at a rate of 300 BAUD (or about 30 
characters per second). Erasable, programmable. Read Only 
Memories (EPROM's) are programmed via a specially constructed 
programmer ciroult connected to a standard (Prolog #7604) I/O 
oard. 
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4.2 SOFTWARE DEVELOPMENT TOOLS 

To bridge the gap between vehicle oontrol algorithms and the 
maohlne language binary program whloh Is actually executed on- 
board the AMTV, a number of sophisticated software tools or 
programs must reside on the hardware system described in Section 
4.1. Figure 4-3 shows a diagrammatic representation of the 
interaction between programmer, software, and hardware which 
allows the transformation of oontrol algorithms Into machine 
language programs residing in EPROMS. 

First, the programmer must be knowledgeable in a high level 
programming language such as FORTRAN. BASIC. PASCAL, or some 
other language. FORTRAN was the language chosen for this task 
based mainly on its availability and popularity. To write a 
program or communicate with any of the software which resides 
either ir the computer's disc storage or its RAM storage a 
program must reside within the memory at all times which acts 
muoh the same as a competent housekeeper. That is. this program 
monitors at all times to the operator's commands which are 
entered via keyboard, correctly interprets these oommands. then 
acts upon them. This housekeeper knows where to find all stored 
items and where to store newly oreated items and keeps an 
elaborate, carefully updated record of size and/or location of 
all stored items. This housekeeper is termed a "DISC Operating 
System.'' The disc operating system used is the CP/M system 
written by Digital Researoh located in Pacific Grove, California. 

Several other utility programs are also employed: PIP to enable 
the user to transfer files, programs, data, etc., from one disc 
to another; STAT, to tell the user how much space is used on each 
disc and by which programs; DIR, to list all of the file 
(program) names stored on any disc; and, SYSGEN, to enable the 
user to initialize a new blank disc with a new disc operating 
system on its first two tracks, All of these utility programs 
were also purchased from Digital Research via Micro/Sys as part 
of the CP/M disk operating system package. 

A number of other small but useful utility programs were supplied 
by Micro/Sys, These included programs which would: erase all 
contents on a disc, check a disc for errors, check the computer's 
RAM memory, list disc contents, etc. 

To write and edit the FORTRAN source code a text editor or word 
processor must be used. The software chosen for this purpose was 
"Wordstar" written by Mlcropro International Corporation located 
in San Rafael, California. This is an outstanding example of 
"oanned software" which lent a great deal of efficiency to 
program development. 
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s PRODUCT 


= PROCESS OR PRODUCT 



FIGURE 4-3. STEPS FOR GENERATING EPROM. Diagram showing steps and intermediate 
products formed to produce a programmed EPROM starting with control 
algorithms. 
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Onoe the FORTRAN code Is written (and stored) on-disc, another 
program must be used to transform it to machine language code 
(more accurately termed relocatable machine language code). The 
software used is the F80 FORTRAN compiler written by Microsoft of 
Bellevue, Washington. All FORTRAN mathematical symbols (/,*,+,- 
,[,]»••, etc.) and functions (sin, cos, log, etc.) use already 
created subroutines stored in relocatable machine language in a 
FORTRAN subroutine library (FORLIB). To combine these subroutines 
with the relocatable machine code output by the (F-80) compiler 
another program termed the L-80 linking loader is used. Both 
FORLIB and L-80 are also supplied by Microsoft. 

After "linking," the resulting machine language program oan be 
loaded into RAM memory and executed, however, it is not quite in 
the correct form for use on an EPROM. Another program termed 
"UNLOAD" makes this final transformation. UNLOAD was supplied by 
another user at JPL. 

Once a program is in the oorrect. form for transfer to an EPROM, 
another program must exist which reads the program from a disc, 
and applies the correct and corresponding voltages to an EPROM to 
permanently record the bits on the EPROM at the correct address. 
This program (termed PROM) was also supplied at the JPL. 


A typical sequence for transforming an algorithm into machine 

code on an EPROM follows: 

1. Use CP/M to verify that disc has enough space left for 
programs. (Time required: about 5 sec.) 

2. Use CP/M to call in WORDSTAR. Enter FORTRAN code lines. Store 
completed FORTRAN source code on disc. Print a copy of program 
for checking and debugging purposes. (This step may take from 
minutes to hours depending upon how much code needs to be 
entered and the typing speed and accuracy of the user). 

3. Use CP/M to call in the F-80 compiler. Supply the compiler the 
file name for the source program created in the previous step. 
Compiler outputs list of syntax errors for user to correct. 
(This step requires from 15 to 30 seconds). 

4. Use CP/M to recall WORDSTAR. Make corrections to FORTRAN 
source code to correct any errors found in compilation in Step 
3. Now store new corrected version of FORTRAN SOURCE code. 
Repeat Steps 3 and 4 until 1 no further syntax errors are found 
by the compiler. (This step usually takes only about 2 minutes 
unless the syntax error is very subtle). 
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5. Use CP/M to oall In the L-80 Linking Loader. Supply the 
"linker" with the name of the compiled file. The product la a 
single program in machine language which incorporates all of 

the FORTRAN source programs converted to maohlne language, and I 

all of the necessary FORTRAN library routines also In machine 

language. j 

Note: In the case of the AMTV controller programs this was one \ 

main program and 11 subroutine programs. The linker put 
together all of these along with all of the necessary FORLIB 
subroutines. (For the controller programs this process takes 

about 2 minutes). j 

) 

6. Use CP/M to oall in UNLOAD. Supply the name of the file which ] 

is to be transformed into EPROM format. (This process takes j 

less than 30 seconds), * j 

I 

7. Use CP/M to call in PROM. Mount erased EPROM in socket and use 1 

PROM to verify that EPROM is erased. Use PROM to transfer I 

program to EPROM. This program actually checks its work by f 

rereading the EPROM and checking that what was recorded was ! 

correct. (This process takes about 2 minutes per EPROM. There 1 

are three EPROMS, each with a capacity of 2048 bytes, used in I 

the AMTV controller at this time). 1 

8. Plug EPROM(s) into Z-80 CPU card. Then plug this card into the | 

STD Bus on board the vehicle and check for correot operation j 

with the vehicle on jacks. (This process takes about 3 J 

minutes). If operation is not satisfactory analyze problem and f 


begin back at Step 2. 



5. SOLID-STATE MOTOR CONTROLLER 


5.1 HARDWARE DESCRIPTION 

As a part of this task a new transistor ohopper motor current 
controller was purohased from EVC Ino* in Inglewood, California. 
This motor controller consists of two separate units (or 
circuits) mounted within the same oase. One unit is a transistor 
ohopper motor current controller, model EVC-400-36-12H, which is 
a standard EVC product. The other unit within the case consists 
of a solid-state circuit, model EVC-SSW400, which is used to 
reverse the field winding polarity of the motor for plugging 
(motor torque reversal). This later unit consists mainly of four 
large silicon controlled reotlflers (SCRs) and was specially 
designed and built at the request of the JPL. The total package 
is EVC model number PMC- 100- 36 . 

The chopper uses high current switching transistors to smoothly 
and efficiently control the speed of the motor. Both portions of 
this motor controller are rated for 400 A. Some of the 
features of this controller are: 

(1) Controller turns off if battery is too low. 

(2) Output current (to motor) outs back if controller is 
overheated. 

( 3) Output stops if motor is shorted. 

(4) Controls maximum battery current (current limiting). 

(5) Full current output can be obtained without using bypass 
relay. 


5.2 PERFORMANCE 

Upon delivery this motor controller did not perform within 
specifications. However, close consultation and cooperation 
between the JPL and EVC resulted in a motor controller which 
operates smoothly over its entire range of motor currents. This 
controller uses only two electromechanical relays: one to turn 
on and off the main power and another (magnetic reed relay) which 
reacts to plugging current. The reed relay is used to reduce the 
motor control analog command voltage magnitude during plugging. 

The SCR field reversing circuit allows transition between forward 
and plugging modes in less than 20 ms. This is far faster and 
quieter than the old relay type reversing oirouit. The advantage 


5-1 





is in eliminating dead time when using relatively tight feedback 
control. Similar advantages are obtained beoause the bypass relay 
(used during high current operation) is eliminated. 

This motor controller has no provision for regenerative braking* 
however* both EVC and General Eleotric are known to be developing 
motor controllers which will incorporate this feature. 

No curves or hard data were taken on the new EVC controller after 
delivery* but curves showing overall vehicle performance using 
this controller are contained in Section 6. 



6. VEHICLE PERFORMANCE UNDER MICROPROCESSOR CONTROL 


6.1 TESTING METHODS 

The performance of the vehicle's sensors has been documented in 
Reference 2, With this in mind it was felt that stopping 
distances and Veloolty versus time curves reoorded during 
acceleration and deceleration testing on the road would be 
sufficient to oharaoterize the performance of the microprocessor 
controlled AMTV. 

Stopping distances were measured between obstaole and vehicle 
front using a standard grey target, a black target (3M Company 
Nextel Velvet Coating 101-C10 black). Iff reflectivity, and 
projeot personnel. 


The speed-versus-time figures in the remainder of this seotion 
were generated in the following manner: the microprocessor was 
programmed (without interfering with the normal control program) 
to output two analog voltages: one proportional to speed and the 
other corresponding to various sensor (e.g., primary, secondary, 
etc.) and switoh (e.g., passenger tape switches, bumper switch, 
etc.) flags via separate digital-to-analog converters (DACs). 
These voltages were monitored in the road using a battery powered 
dual-trace storage-type oscilloscope. Next, these oscilloscope 
Images were photographed using a Polaroid oscilloscope camera. 
These Polaroid images were enlarged, then traoed onto mylar 
plates. Because of the graphical steps Involved and the inherent 
accuracy limits of an oscilloscope, accuracy is estimated to be 
within ± 5ff. 


6.2 DECELERATION AND STOPPING PERFORMANCE 

Figures 6-1 through 6-7 show speed-versus-time for various 
initiated stops. Arrows pointing up the abscissa indicate the 
time at which a sensor or switch was first recognized by the 
oomputer. These arrows are coded to indicate which sensor or 
switch they represent. The numeral "I" represents a primary 
sensor, the numeral "2" represents a secondary sensor, the letter 
"R 1 ? indicates a road magnet was "read," and the letter "T" 
indicates that a passenger tape switch was squeezed. Arrows 
pointing down in Figure 6-4 indicate the time at which the 
indicated flag was cleared. 

These tests were all made during downhill runs on the same day 
within about 1 h. Exact conditions and run descriptions are given 
in each figure. 
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FIGURE 6-1. DECELERATION CURVE. Sensor-induced stop. Note vehicle deceleration to 3.2 km/hr while 

primary sensor on, and from 3.2 km/hr to rest with secondary sensor on. Obstacle is adult 
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FIGURE 6-2. DECELERATION CURVE. Sensor-induced stop using black (3M Co. Nextel Velvet Coating 
101-C10 Black) target. Note the lack of 3, *2 km/hr plateau. This is due to a later 
than normal detection of target by primary sensors, thus leaving less time tc dwell 
at the 3.2 km plateau. 




jumping into field of view at about 3.3 m in front of the vehicle. First dip in curve 
to 0 velocity represents rear wheel skidding rather than true vehicle speed. Vehicle 
travelling down approximately 4% grade. Pedestrian is adult wearing clothing of medium 
reflectivity. 
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FIGURE 6-5. DECELERATION CURVE* Road stop (Induced by sensed road magnet) - Vehicle travelling uphill 
just before sensing magnet- Note that the speed at beginning of stop is belot* cruising 
speed. Motor controller turned fully on just prior to stop. 




FIGURE 6-6. DECELERATION CURVE. Road stop (induced by sensed road magnet). Vehicle travelling 

slowly up steep incline just before sensing magnet. Motor and motor controller fully 
turned on just prior to stop. Also note the two stage stop with the intermediate 
velocity at nearly 3.2 km/hr. 




FIGURE 6-7. DECELERATION CURVE. Passenger (tape switch )~induced stop. Vehicle controlling speed at 
cruise using plugging just prior to stop. Stop *nade on downhill grade. 
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Although no table of values for stopping distance will be 
presented, numerous trials using both black and grey targets and 
human subjeots at various initial speeds and on different grades 
have proven that the AMTV will stop with approximately .7 m to 
spare if the sensed obstacle does not suddenly intersect the 
field of view from the side. Obstacles which suddenly intersect 
the field of view may be struck only if they do so when the 
vehicle is going too fast to stop with locked rear wheels. 
Section 7 will review the algorithms or deceleration philosophy 
used for sensed obstaole stops. 


6.3 ACCELERATION PERFORMANCE 


Acceleration from rest is carried out in two stages or plateaus. 
The vehicle is first accelerated to 3.2 km/h and upon obtaining 
this speed holds it for approximately 3 s. This initial slow 
velocity is intended to allow pedestrians and other vehicle 
drivers to observe and react to AMTV motion. The vehicle is then 
accelerated to its terminal speed of 11 km/h. On uphill runs 
this AMTV will not attain this top speed because of lack of motor 
size (torque). On level or downhill runs the vehicle will limit 
its speed to approximately 11.2 km/h by reducing forward motor 
torque or by plugging. Acceleration is limited to .16 g by 
feedback control using speed sensing and microprocessor 
calculations. Additionally, jerk, the time rate of change of 
acceleration, is held to comfortable limits by limiting the rate 
of change of motor current. 


Figure 6-8 illustrates a typical acceleration to cruising speed 
from rest. This run was recorded on a slight downhill grade. 


6.4 SPEED CONTROL 


Vehicle speed is controlled at approximately 11 km/h for cruise 
speed. A speed of 3.2 km/h is used for: turning (such as "U- 
turns,") for maximum speed when the primary sensor has observed 
an obstacle, or for an initial control speed after sensing a road 
stop magnet. The vehicle attempts to reach either speed by 
either accelerating to it if traveling too slow or by reducing or 
reversing (plugging) motor torque if travelling too fast. Our 
measurements indicate that the vehicle speed is controlled to 
within approximately .3 km/h when not in transition between 
command speeds. 


6-9 


OF POOR QUALITY 


- J, 

i $ 




^ I ridhr nrr TTr^r iTTf t iK *»-*-**■***. - * < - 





7. SAFETY ASPECTS OF CONTROLLER DESIGN 


7.1 KEEP ALIVE FUNCTION 

A number of microprocessor hardware failure modes exist. Many of 
these failure types result In a disruption of the basic timing 
cycle Inherent to the software; that Is, the software Is designed 
to cycle through the entire program every 20 ms under all but 
"emergency stop" conditions. As the program runs, It outputs a 
"keep-alive" (pulse) signal (analogous to a heartbeat) once every 
20 ms on one of Its numerous TTL output lines. A special card 
was designed and fabricated to monitor this signal* Any 
disruption in this signal's timing will cause this card to 
Initiate a full emergency stop; that is, motor controller turned 
off and hydraulic brakes turned full on. 

The keep-alive card presently has a weakness, In that It uses the 
same power source as the STD Bus, therefore, a bus power failure 
may not result in an emergenoy stop. This weakness will be 
remedied on the next vehicle. 

The clroult has been successfully tested by disconnecting the Z- 
80 (CPU) card. This card has a built-in self- test button which 
has also proven to work effectively. 


7.2 DUAL DIGITAL TACHOMETERS 

The AMTV uses two identical digital tachometers. Each tachometer 
Is driven by an "0"-ring belt attached to a pulley driven by the 
pinion shaft on the differential. For additional reliability, 
the two tachometers should be separated and each mounted on a 
different wheel. Each tachometer is connected by cable to a 
special tachometer card interfaced to the microprocessor via the 
STD Bus, Each card yields a 16-bit number which is proportional 
to speed every 20 ms. 

The controller software checks each taohometer card for readiness 
to deliver its data number. If either or both tachometers fall 
to be ready to deliver their data within approximately 20 ms the 
vehicle will make an emergenoy stop. Assuming that both 
tachometers can be read, If they do not agree within a 
predetermined tolerance for a predetermined number of cycles, 
then a tachometer malfunction is assumed and the vehicle Is 
brought to an emergency stop. This leaves the case that neither 
tachometer registers a speed greater than zero (such as if both 
drive belts break simultaneously) but the vehicle is nevertheless 
moving. This condition is checked by noting the magnitude of the 
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motor oontrol voltage* If this voltage Is above a predetermined 
small quantity, It is assumed that the vehicle must be moving and 
a reading of zero by either tachometer is considered an error 
serious enough to warrant an emergency stop. 

In summary, a malfunction of either or both tachometers is 
detected and reaultr in an emergency stop* This safety feature 
has also been tested and proper operation has been verified under 
all possible fault conditions. 


7*3 BACK-UP SYSTEMS 

At the present time the controller does not determine if the 
motor or motor controller are doing an effective job of stopping 
the vehicle. In the case where a stop has been commanded (by 
optical sensor, tape switoh, or road stop magnet) and the motor 
controller or motor fails to obey commands issued by the 
microprocessor, the following mechanisms are available to bring 
the vehicle to a stop via the hydraulic brake system: first, the 
emergency stop push buttons (if depressed by a passenger); 
second, the front (whisker type) bumper upon contacting some 
object; and third, if the vehicle exceeds 12 km/h in the forward 
direction or rolls backwards more than .5 M, This type of stop 
is termed an "emergency stop" and the vehicle will not resume 
operation unless the controller reset button is depressed. All 
other types of stops rely on the ability of the motor to plug. 

When executing normal stops, the vehicle uses its hydraulic brake 
system to bring the vehicle to a complete halt (from a speed 
below about .3 km/h) and hold the vehicle stopped for the desired 
period of time. If the hydraulic brake system should fail to 
operate, the microprocessor controller will complete the stopping 
process and hold the vehicle stationary using only the motor. 
Note that this backup system only works from a very low speed 
when stopping. This system has also been tested and shown to 
work satisfactorily. 


7>* RUNAWAY OR ERROR DETECTION 


As mentioned above, if the vehicle speed exceeds 12 km/h or if 
the vehicle proceeds backwards by more than .5 M, it is assumed 
by the microprocessor controller that normal motor speed control 
is inoperative, and an emergency stop is instituted. An 
emergency stop consists of opening the main relay (removing all 
power) of the motor controller and turning the hydraulic brakes 
full on. Once the vehicle is at rest it can then only be 
restarted by depressing the controller reset button. Both 
runaway conditions have been created on the road and the vehicle 
has responded with emergency stops as programmed. 
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7.5 VEHICLE ELECTRIC HORN 


The AMTV has been fitted with an automotive type (12 V) horn. 
This horn is presently programmed to sound two short honks just 
before the vehicle accelerates from rest. It is anticipated that 
this horn will be used for other purposes as well in the future 
(see Section 8). This warning sound function has been tested and 
found to be fairly effective in alerting pedestrians and other 
vehicles of impending AMTV motion. 


7.6 SPECIAL PAST STOP ALGORITHM 

The controller now includes a special stopping algorithm designed 
to bring the vehicle to a fast stop in response to an anomalous 
optical sensor indication. If the vehicle speed is above 4.7 
km/h, the controller calculates the deceleration necessary to 
stop the vehicle within 1.8 m and then uses plugging to attempt 
to attain this deceleration level. This mode is intended to 
function when an obstacle suddenly appears in front of the 
vehicle, not allowing the vehicle time to make a normal (.16 g) 
stop. The fast stop can be as severe as an emergency stop in 
that the rear wheels will slide. This type of stop may not be a 
comfortable stop for passengers, however, its main function is to 
protect pedestrians who suddenly move in front of the vehicle at 
a distance such that the vehicle cannot make a normal stop. 

This fast stop algorithm has been extensively tested and found to 
be very effective. 


7.7 FAIL-SAFE ANALYSIS 

A failure analysis of the microprocessor controller and of 
certain critical sensor failures was carried out and the results 
are tabulated in Appendix C. The analysis was done following the 
same rationale as the failure modes and effects analysis 
presented in Reference 1. The present results can be considered 
an extension of the earlier analysis. A block diagram of the 
microprocessor controller, shown in Figure 3-3, was used as a 
guide, with the effect of a failure of each block being 
determined by analyzing the consequenses of worst-case false 
inputs from that block. The format of the tables is similar to 
Reference 1, except that a column indicating when implementation 
of the preventive action could occur is added. 

In summary, a little less than half of the identified items are 
already implemented or planned for in the initial development 
phase of the follow-on vehicle (AMTV II). The most effective 
single test for future development is felt to be that of 
comparing the actual vehicle speed with a speed predicted by an 
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an approximate algorithm based on existing sensor or passenger 
inputs. The model could be in a separate Z-80 card, which cross 
checks with the present oard for correct function. Table 7-1 is 
a condensed summary of the most important results of the 
analysis. 



TABLE 7-1- EXAMPLE OF MICROPROCESSOR CONTROLLER FAILURE MODE ANALYSIS 
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8. FINDINGS AND RECOMMENDATIONS 


8.1 VEHICLE ALGORITHMS 

All algorithms function as written and Intended. Fairly 
extensive road testing and the failure analysis desorlbed 
previously have led us to a number of suggested improvements and 
modlfioations whloh would enhanoe AMTV performance and safety. 
These modifications are listed below: 

(1) Front and rear turn signals whloh turn on prior to an actual 
turn using a coded road-based signal. 

(2) Motor and/or motor controller feedback to the microprocessor 
controller indicating the effectiveness of microprocessor 
controller commands. This oould be supplemented by or even 
replaced with some type of model , as discussed in the 
previous seotlon. 

(3) Additional horn warnings should be issued for appropriate 
conditions suoh as secondary sensor remaining on indicating 
that the AMTV path is blooked. This algorithm (or 
modification) would have to use some "sense" in not honking 
at inappropriate times. 

( 4) Tachometer signals have turned out to appear somewhat noisy, 
thus leading to very noisy acceleration data. It is believed 
that the taohometers are accurate; i.e., there is some 
randomness in the sensed speed at the tachometers due to gear 
backlash, tire and belt slippage, and/or eccentricity, etc. 
This noise is relatively well tolerated by the system. 
However, more reliable and repeatable performance could be 
attained if tachometer filtering could be introduced. 
Additionally; smoother stops would likely result. A 
tachometer filtering method is therefore recommended. 


8.2 VEHICLE SOFTWARE 

The Microsoft F-80 FORTRAN used for this task proved to work very 
satisfactorily. The tachometers are sampled every 20 ms (50 
samples/second), thus the time needed to oycle through the 
program must remain less than 20 ms. Actual measurements 
indicate that the program executes in about 4 ms and "idles" for 
about 16 ms waiting for the 20 ms flag to come up. This 
indicates that only about 20 % of the available processing time is 
actually used to perform calculations, tests, and to input or 
output data. 
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The ability to ohange program parameters on the street was never 
developed due to the lack of standard hardware when the task was 
undertaken and the additional programming neoessary. We now have 
what is probably the oorreot hardware but have determined from 
muoh testing and modification experience that a large percentage 
of changes involve actual program modification (rather than just 
modifying a parameter) and small changes take less than 15 min to 
make using the development system located in the laboratory. 


8.3 SOFTWARE DEVELOPMENT SYSTEM 

The Mlcro/Sys development system as now configured (see Section 
4) is a self-contained and efficient means for providing software 
for microprocessor controller use. Future enhancements, upkeep, 
and replacements are expected, but will not ohange the system in 
any fundamental way. 


8.4 MOTOR CONTROLLER PERFORMANCE 

The new EVC motor controller is now performing adequately under 
repeated rapid stop conditions but seems to get quite warm, whioh 
may not be the case under normal use. Thermostatioally-controlled 
forced cooling would reotify any potential problem. Very low 
current plugging may not be as smooth and predictable as required 
for bringing the vehicle to a complete stop without using the 
hydraulic brakes. At this time, indicated vehicle speed 
fluctuations overshadow or preolude this use. A method is 
available to Improve the low current plugging ability of the 
motor current controller. This method consists of direct computer 
control of the motor current controller input voltage without the 
use of the provided plugging relay. This relay is presently used 
to rescale motor control input voltage when plugging current is 
some small magnitude. 


8.5 VEHICLE PERFORMANCE 

Vehicle performance is generally smooth and predictable. 
Stopping and starting characteristics and other performance 
characteristics can be modified easily by simply changing 
software. 

It is probable that (using the ourrent software) minor software 
changes would have to be made to adapt an AMTV to a new 
environment. It is believed that with some field experience the 
software could be made to function properly in virtually any 
setting or environment. 




8-2 


The completion of this task has provided a microprocessor- 
controlled ANTV whose performance is smoother, more flexible, and 
safer than was presently possible without the microprocessor* In 
addition, many safety-related improvements are incorporated, or 
are feasible for future development* 


8.6 VEHICLE PERFORMANCE — SAFETY RELATED 

Recommendations are listed below: 

(1) Sensors which allow the vehicle to sense obstructions while 
turning are still needed (References 1 and 2). 

(2) Four-wheel hydraulic brakes for emergency stops are desir- 
able* Preferably, this system would inoorproate 
proportionally- controlled pressure or stopping force. 

(3) Some sort of motor controller feedbaok, suoh as motor 
ourrent, is important for monitoring stopping performance, 

(i|) A spring-applied electrically-released brake is required to 
bring the vehiole to a stop and hold it when a system power 
failure occurs. 


8.7 LONG TERM RESEARCH AND DEVELOPMENT 

Having a microprocessor on-board an AMTV opens up the 
possibility for future development of many improvements in 
vehicle funotlon and safety. -So be examples include the 
following: 

1. fiflUtinuoafl monitoring OX censor other malor subsystem 
function ££ "health.” This could be accomplished for all vehicle 
sensors (not just the optioal headway sensors) and also for 
components suoh as motors, motor controllers, hydraulic system 
components, lights, etc., In an analogous manner to that which is 
routinely done on spacecraft. For example, motor current and 
temperature oould be monitored continuosly and compared to the 
normal range. This monitoring oould be used for early warning of 
impending failure, automatic switchover to back-up systems, and 
as an aid to system maintenance. 

2* MU cn- board. £&JMlLtt£r.r£SiIltl',Qlled voice synthesizer. 

Recent advances in this technology have led to the production of 
single-chip inexpensive voice synthesizers. These chips use 
binary-coded information supplied from a microprocessor's memory 
and output audio frequency analog electrical signals whioh, when 
amplified and fed to a speaker, produce clearly understandable 
human speech. The entire system would be very small, 
inexpensive, flexible, and reliable. A multitude of specialized 


messages oould be retained in microprocessor memory, any one, or 
combination of whloh, oould be announced as a result of a 
particular state or history of sensor Inputs. These messages 
could instruot or warn passengers or even pedestrians. Suoh a 
message might tell a passenger how to restart an AMTV that has 
oome to an emergency stop or request that the passenger check for 
open or jammed doors or summon help. These messages oould be 
easily modified, updated or added to by simply inserting a single 
programmmed EPROM on a microprocessor board. Imagine a vehicle 
that could yell "someone help me" when its sensors indicate that 
it is in trouble! 

3. Salf-chaoking controller software. Additional work needs to 
be done on microprocessor controller self-oheoking routines. In 
particular, subroutines can be used to oheok the health of the 
RAM memory chips. With some additional hardware design, perhaps 
every card in the controller could be tested periodically with 
the results available via voloe synthesizer as mentioned 
previously, LED character display, or in typewritten form using a 
plugged In printer. This last form of vehicle health 
documentation may be particularly useful in terms of long-term 
maintenance and in cases of liability where maintenence is 
questioned. The vehicle could literally keep its own maintenance 
reoords. 
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FIGURE A- 3. AMTV M P CONTROLLER PROGRAM SUBROUTINE "DATAIO" 
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FIGURE A— 4 . AMTV fjP CONTROLLER PROGRAM SUBROUTINE "TACHRD 










FIGURE A-5. AMTV /iP CONTROLLER PROGRAM SUBROUTINE "FLGSET 1 




































FIGURE A-7. AMTV //P CONTROLLER PROGRAM SUBROUTINE "RUNWAY 
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FIGURE A-8. AMTV /iP CONTROLLER PROGRAM SUBROUTINE "TSTOP" 













FIGURE A-9. AMTV (iP CONTROLLER PROGRAM SUBROUTINE "DECEL' 
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FIGURE A-10. AMTV fi? CONTROLLER PROGRAM SUBROUTINE "ACCELR" 
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FIGURE A-12 . AMTV fi? CONTROLLER PROGRAM SUBROUTINE "EMSTPR" 
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C MAIN Cl] A MTV CONTROL PROGRAM 

C 

C (REVISED 8/21/80) (COMtffiNTS ADDED 9/16/80) 

C 

CIHHHIlHIlfllHIIIIHIIIIIIHIIIimilllllllllHIHIIHHmiHII 

PROGRAM MAIN 

LOGICAL BADRD, BRAKES , COUNT, C0UNT2 ,DSTRST , EMSTOP , FASTOP , 

•F 1 , F 1 CNT , F 1 L AST , F2 , F2CNT , F2L AST , F3 , F3CNT , F3L AST , 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 

#F7 , F?CNT , F7L AST , F8 , F8CNT , F8L AST , F9 , F9CNT , F9L AST , 
*F10,F1QCNT,F10LST, 

SKCNT2 | KCOUNT , NONE , KTHREE , KTWO , L , L2 ,MALTAK , 

•NRMSTP , PLUG, POWER , RBRST.RDYI , RDY2 , SLOWDN , 

•TAKRDY , TKSLR ,TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 

LOGICAL KBRAKE,KLIVE, KPLUG , KPOWER , L1YE , PLGLST 

CHIIIIHIIIIIIIIIIIHIIIIIHilliillllllllliillllHIHimiHHH 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDL A , DIST , 

•INCACC, INCEM, INCFST , INCNRM , INCR , INCSLO , 

•DISTM,DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF, LHIGH , 

•LLQW , LSB, MAXRBD , MSB, MSBO , K4CNT, NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 , TAKOLD, TAKTOL , TPLAT , VELCQN , VELERR , VELMAX , VELOC , 

•VMC , VMCQUT , WAITMX , X , Y 

GiMiiiiiiiiiiiiiiiiiHHHiiiiHimMmmiHmiHHmiiiH 

COMMON /L/BADRD, BRAKES, COUNT, C0UNT2,DSTRST,EMST0P,FAST0P, 
•F1,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 

*F7 , F7CNT , F7LAST , F8 , F8CNT , F8LAST ,F9 , F9CNT , F9LAST , 
•F10,F10CNT,F10LST, 

•KCNT2 ,KCOUNT,KONE , KTHREE, KTWO, L,L2 ,MALTAK, 

•NRMSTP , PLUG, POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 

COMMON /Li /KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

CIHIHIIIIItllllllllllllHIlHIHIIIMHIlHHHHHMHIHHH 

COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX » ACCOLD , BRKDLA , DIST , 
•INCACC, INCEM, INCFST , INCNRM , INCR , INCSLO , 

*DISTM,DLA1 , INPO , INP1 , INP17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB, MAXRBD, MSB, MSBO, K4CNT, NUMOUT, PLAT1, 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

CHIHIHIHHIMHIlHIIMIIHHIMHIIIHHHHnVItiHIIIIHI 

THIS IS THE BEGINNING OR RESET POINT»»«««»»««»»»»»**» 

C NEXT SUBR DOWNLOADS ALL VARIABLES AND CONSTANTS INTO RAM AND GIVES 

C INITIAL CONDITIONS TO ALL OF THEM 
CALL DNLOAD 

C NEXT SUBR PERFORMS I/O OF MOST VARIABLES AND SCALES SOME OF THEM 

100 CALL DATAIO 
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C NEXT SUBR READS TWO DIGITAL TACHOMETERS 
CALL TACHRD 

C NEXT SUBR SETS OR CLEARS APPROPRIATE FLAGS BASED ON LATEST TTL INPUTS 
CALL PLOSET 

C NEXT STATEMENTS ALLOW IMMEDIATE BRANCH TO EMERG STOP ROUTINE 
d IF INDICATED BY ONE OF THE LATEST INPUTS 
IF(EMSTOP.EQ.I) CALL EMSTPR 
C NEXT SUBR DETERMINES NEW CONTROL VELOCITY 
CALL CTRLV 

C NEXT EXPRESSION CALCULATES VELOCITY ERROR 
VELERR*VELCON-TAK1 

NEXT EXPRESSIONS USED TO OUTPUT FLAG AND SPEED DATA VIA DAC 
KACCELeF3 i 10+FA»20+F6»30+F10«40 
KACCEL*TAK2/20 
CALL POKE(-17,KACCEL) 

KTAKsTAKI/20 
CALL POKE(-18,KTAK) 

NEXT EXPRESSION RESCALES ACCEL FOR LATER USE 
ACCEL* ( TAK1 -TAKOLD) *256 
C NEXT SUBR DETERMINES IF THEIR IS A RUNAWAY CONDITION 
CALL RUNWAY 

IF(EMSTOP.EQ.I) CALL EMSTPR 

C NEXT WE DETERMINE IF ACCELERATION OR DECELERATION IS CALLED FOR 
C BY COMPARING CONTROL AND ACTUAL VELOCITY; BUT FIRST, ARE WE IN THE 
C MIDDLE OF A TIMED STOP? VARIABLE KTWO*3 DURING TIMED STOP PERIOD 
IF(KTWO.EQ.3) GO TO 160 
IF( ( VELCON-YAK1 ) .LE.O) GO TO 150 
140 CALL ACCELR 

GO TO 100 
150 CALL DEGEL 

GO TO 100 
160 CALL TSTOP 

GO TO 100 
END 
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SUBROUTINE DNLOAD [2]., .DOWNLOADS AND INITIALIZES VARIABLES INTO RAM 
(REV. 7/15/80 (COMMENTS ADDED 9/16/80) 

SUBROUTINE DNLOAD i 

LOGICAL BADRD, BRAKES, COUNT, C0UNT2,DSTRST,EMST0P,FAST0P, j 

•FI ,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, j 

•F4 ,F4CNT,F4LAST ,F5,F5CNT ,F5LAST ,F6 ,F6CNT ,F6LAST , ! 

•F7 f F7CNT,F7LAST,F8»F8CNT,F8LAST,F9,F9CNT,F9LAST, j 

•F10,F10CNT,F10LST, S 

•KCNT2 ,KCOUNT , KONE , KTHREE , KTWO , L , L2 ,MALTAK , ! 

•NRMSTP , PLUG, POWER , RBRST , RDY1 , RDY2 , SLOWDN , j 

•TAKRDY , TKSLR , TMDSTP ,IRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
LOGICAL KBRAKE,KLlVE,KPLUG,KPOWER,LIVE,PLGLST j 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , I 

•INCACC , INCEM, INCFST , INCNRM , INCR , INCSLO , J 

•DISTM,DLA1 , INPO , INP1 , INP 17 . INP2 , INP3 , INP4 , I 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 1 

•LLOW , LSB,MAXRBD , MSB , MSBO , K4CNT, NUMOUT , PLAT1 , j 

•PWAIT , RBDIST , SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, ] 

•TAK3 , T AK OLD , TAKTOL , TPL AT , VEL C ON , VELE R R , V ELMAX , VELOC , f 

•VMC , VMCOUT , WAITMX , X , Y I 


COMMON /L/BADRD, BRAKES, COUNT, C0UNT2,DSTRST,EMST0P,FAST0P, 
•F1,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 

•F7 , F7CNT , F7LAST ,F8 , F8CNT , F8LAST , F9 ,F9CNT , F9LAST , 
•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT , KONE , KTH REE , KTWO , L , L2 , MALT AK , 

•NRMSTP , PLUG, POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
COMMON /L1/KBRAKE , KLIVE , KPLUG, KPOWER ,LIVE , PLGLST 

CIMHMHHHMIllHIHliHIHIIIlHIHIIIHIIHIHIIIHHHIl 

COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC , INCEM, INCFST , INCNRM , INCR , INCSLO , 

•DISTM,DLA1 , INPO , INP1 , INP 17 , INP2 , INF3 , INP4 , 

•INP9 ,INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K4CNT , NUMOUT , PLAT1 , 

•PWAIT, RBDIST, SAT 1 ,SAT2 ,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 , TAKOLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 


CMmmmiimimmHiiHmHimiimi 

ClHHIIIHtllllMIIIHtHHHIMlIlllillHIK 

CHlimimtiHlt DOWNLOAD INTEGER VARIABLES 


ABSTAK =0 
C SPARE VARIABLE 
ABSVEL=0 

C ABSOLUTE VALUE OF VELOCITY FROM DIG TACH #1 
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AC CEL =0 

C ACCELERATION (TAK1-TAK0LD) 

ACCMAX=5376 

C MAXIMUM ALLOWED ACCELERATION 
BRKDLAsO 

C BRAKE HOLD DELAY TIME, PREVENTS ROLLBACK 
DISTsO 

C SCALED DISTANCE REG. CONTAINING DISTANCE PAST PASSENGER STOP MAGNET 

C TRUE DISTANCE = 10,500 CTS/FT. SCALED DIST IS TRUE/8 
DISTM=11 150 

C SCALED DIST FRM TRAM STP BUTTON § WHICH CNTRL VEL DROPS TO 0 

C SAME SCALING AS VARIABLE DIST ABOVE. 

DLA1s5 

C MAXIMUM BRAKE HOLD DELAY TIME (50/ SEC) 

INCEMsI 

C SUBSTITUTED FOR "INCR" DURING CERTAIN CASES 
INCFSTs7 

C SUBSTITUTED FOR "INCR" DURING CERTAIN CASES 
INCNRMsJj 

C SUBSTITUTED FOR "INCR" DURING CERTAIN CASES 
INCSL0=3 

C SUBSTITUTED FOR "INCR" DURING CERTAIN CASES 
INCACC=2 

C SUBSTITUTED FOR "INCR" DURING ACCELERATION 
INCR=0 

C INCREMENT USED IN M/C INCREMENTING EQUATIONS 
INP0=0 

C INTEGER VALUE OF BYTE READ FROM PORT #0 
INPIsO 

C INTEGER VALUE OF BYTE READ IN FROM PORT #1 
INP17=0 

C INTEGER VALUE READ IN FROM PORT #17 
INP2=0 

C INTEGER VALUE OF BYTE READ IN FROM PORT #2 
INP3sO 


C INTEGER VALUE OF BYTE READ IN FROM PORT #3 
INPIsO 

C INTEGER VALUE OF BYTE READ IN FROM PORT #4 
INP9=0 

C INTEGER VALUE OF BYTE READ IN FROM PORT #9 
INTA=0 

C INTERCPT: VEL ERROR VS ACCMAX CURVE FOR ACCELERATION 
INTDsO 

C INTERCEPT; VEL ERROR VS ACCMAX CURVE FOR DECELERATION 


K=0 


C SPARE VARIABLE 


L2HIGH=0 

C HIGH ORDER BYTE FOR TAK2 
L2L0W=0 

C LOW ORDER BYTE FOR TAK2 
LDIFFsO 

C DIFFERENCE BETWEEN TAK1 AND TAK2 


LHIGHsO 

C HIGH ORDER BYTE FOR TAK1 
LLOWsO 

C LOW ORDER BYTE FOR TAK1 
LSBsO 

C SPARE VARIABLE 

MAXRBDb2600 

C MAXIMUM ALLOWED ROLL BACK DISTANCE DIVIDED RY 8 TRUE. 

C TRUE SCALE FACTOR IS (10,500 CTS/FT) 

MSBbO 

C SPARE VARIABLE 
MSB 0=0 

C SPARE VARIABLE 
K4CNT=0 

C COUNTER USED FOR HONKING HORN 
NUM0UT=0 

C SPARE VARIABLE 
PLAT1 =200 

C PLATEAU TIME PERIOD MAXIMUM VALUE (50/ SEC) 

PWAIT=0 

C PASSENGER STOP WAIT PERIOD REG. (50/ SEC) 

RBDISTsO 

C ROLLBACK DISTANCE REGISTER 
SAT1=5376 

C MAXIMUM (SATURATION LEVEL) FOR ACCMAX CURVE 
SAT2 =-5376 

C MAXIMUM (SATURATION LEVEL) FOR DECEL MAX CURVE 
SLOPA= 1 0 

C SLOPE :VEL ERROR VS ACCMAX CURVE FOR ACCEL 
5L0PD= 1 0 

C SLOPE :VEL ERROR VS ACCMAX CURVE DURING ACCEL 
TAK1 =0 

C PRESENT VALUE OF DIG. TACH. #1 
TAK2=0 

C PRESENT VALUE OF DIG. TACH. #2 
TAK3=0 

C SPARE VARIABLE 
TAK0LD=0 

C LAST VALUE OF DIG TAK1 
TAKT0L=200 

C LARGEST ALLOWABLE DIFFERENCE BETWEEN TAK1 AND TAK2 
TPLATsO 

C PLAT. TIME PRD REG FOR 2 STAGE ACCEL, (50/S) 

VELC0N=0 

C CONTROL VELOCITY 
VELERRsO 

C VELOCITY ERROR (CONTROL-ACTUAL) 

VELMAX=2300 

C MAXIMUM ALLOWED VEHICLE VELOCITY ( APPROXIMATELY 310/1 MPH) 
VMCsO 

C MOTOR CONTROL VOLTAGE [0-255]=[0-10VQLTS] 

VMCOUTbO 
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C SCALED MTR CNTRL VOLTS FOR DAC 
WAITMXS50 

C WAIT PERIOD DURING TIMED STOP (50/ SEC) 

Xs=50 

C VEL TOL ABOVE WHICH MTR USED TO HLD VEL0C=0,DIG TAK (310/MPH) 
Y=20 

SPARE VARIABLE 

lllimimHIlHIHIIMIIIHIIHIIIIIIIIIIHHIlHHIIIHIIIII 

•••••§••••••••••••• NOW DOWNLOAD LOGICAL VARIABLES •••••••••• 


BADRDsO 

C REGISTER FOR # OF TIMES LDIFF > TAKTOL 
BRAKESsO 

C HYDRAULIC BRAKES VALVE CNTRL SIG. ON=1 
COUNTsO 

C REG. # OF TIMES ONLY ONE TACH READY TO READ 
COUNT2=0 

C REG. # OF TIMES THAT NO DIG TACH READY TO READ 
DSTRSTsO 

C DISTANCE REGISTER RESET FLAG PROGRMD STOPS, IsRESET 
EMSTOPsO 

C EMERGENCY STOP FLAG , STOPS 
FI =0 

C EMERG STOP PB SWITCH 
FICNTsO 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES FI si 
F1LAST=0 

C HOLDS LAST VALUE OF FI UNTIL FI HAS REMAINED FLIPPED FOR N TIMES 
F2s0 

C BUMPER SWITCH 
F2CNTsO 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F2s1 
F2LAST=0 

C HOLDS LAST VALUE OF F2 UNTIL F2 HAS REMAINED FLIPPED FOR N TIMES 
F3=0 

C PRIMARY SENSOR, DETECTS SOMETHINGS 
F3CNT=0 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F3=1 
F3LAST=0 

C HOLDS LAST VALUE OF F3 UNTIL F3 HAS REMAINED FLIPPED FOR N TIMES 
FH=0 

C SECONDARY SENSOR, DETECTS SOMETHINGS 
F1»CNT=0 

C COUNTER USED TO COUNT NUMBER OF CONSECUTIVE TIMES FM=1 
FMLAST=0 

C KEEPS LAST VALUE OF FM UNTIL FH HAS REMAINED FLIPPED FOR 5 CONSECUTIVE TIMES 
F5=0 

C LEFT TURN SENSOR, DETECTS SOMETHINGS 
F5CNT=0 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F5S 
F5LAST&0 

C HOLDS LAST VALUE OF F5 UNTIL F5 HAS REMAINED FLIPPED FOR N TIMES 
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F6*0 

C BOARDING TAPE SWITCH, CLOSEDsI 
F6CNTsO 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F6*1 
F6LAST=0 

C HOLDS LAST VALUE OF F6 UNTIL F6 HAS REMAINED FLIPPED FOR N TIMES 
F7s0 

C LOSS OF WIRE SIGNAL, LOSTsI 
F7CNTsO 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F7*1 
F7LASTsO 

C HOLDS LAST VALUE OF F7 UNTIL F7 HAS REMAINED FLIPPED FOR N TIMES 
F8=0 

C STEERING ANGLE INDICATOR, TURNINGS 1 
F8CNT=0 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F8s1 
, F8LAST=0 

' C HOLDS LAST VALUE OF F8 UNTIL F8 HAS REMAINED FLIPPED FOR N TIMES 

: F9=0 

C HYDRAULIC SYSTEM LOW PRESSURE, LOWsI 
F9CNTsO 

C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F9=1 
i F9LASTsO 

C HOLDS LAST VALUE OF F9 UNTIL F9 HAS REMAINED FLIPPED FOR N TIMES 
F10=0 

C ROAD MARKER DETECTION SIGNAL, DETECT* 1 
F10CNT=0 

► C COUNTER USED TO COUNT # OF CONSEQUTIVE TIMES F10=1 

FIOLSTsO 

C HOLDS LAST VALUE OF FIO UNTIL FIO HAS REMAINED FLIPPED FOR N TIMES 
- 1 FASTOPsO 

i 1 C FAST STOP FLAG, STOP=1 

KBRAKErO 

C USED IN SUBR DATAIO, RETAINS VALUE OF BRAKES 
KCNT2=0 

C REGISTER FOR # OF TIMES NEITHER DIG TAK READY TO READ 
KCOUNTsO 

C REGISTER FOR # OF TIMES ONLY ONE DIG TAK READY TO READ 
KLIVEsO 

t> C USED IN SUBR DATAIO , RETAINS VALUE OF LIVE 

KPLUG=0 

C USED IN SUBR DATAIO, RETAINS VALUE OF PLUG 
| KPOWERsO 

I C USED IN SUBR DATAIO, RETAINS VALUE OF POWER 

,! KONEsO 

C SPARE VARIABLE 

I KTWOs 1 

C USED AS FLAG TO INDICATE TIMED STOP UNDERWAY (KTWO=3 DURING TIMED STOP) 
jt L=0 

C STATUS REGISTER FOR TAK1 
1 L2=0 

C STATUS REGISTER FOR TAK2 
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LIVEs 0 

C INITIAL VALUE FOR OUTPUT PORT 6 
MALTAKsO 

C USED TO LIGHT TACH MALFUNCTION INDIC. LT. IsLT ON 
NRMSTPsO 

C NORMAL STOP FLAG, STOPs 1 
PLUGsO 

C MOTOR CONTROL PLUG/NO PLUG CONTROL :PLUGsO>FOHWARD MOTION 
PLGLSTsO 

C LAST VALUE OF PLUG USED IN SUBR DATAIO 
POWERs 1 

C USED TO HOLD MAIN PWR RELAY CLOSED, IsCLOSED 
RBRSTsO 

C ROLLBACK DIST. REG. RESET FLAG, IsRESET 
RDYlsO 

C FLAG FROM TACH 1 INDIC READY TO BE READ 
RDY2=0 

C FLAG FROM TACH 2 INDIC READY TO BE READ 
SLOWDNsO 

C SET=1 IN SUBR. FLGSET IF PRIMARY SENSOR OR STEERING ANGLE ARE ON 
TAKRDYsO 

C TACH. OUTPUTS READY FOR READING 
TKSLRsI 

C USED AS FLAG INDICATING BAD TACHOMETER 
TMDSTPsO 

C TIMED STOP FLAG, IsSET 
TRMSTPsO 

C SET AFTER ROAD MRKR DETECTED. USED IN TIMED STOP 
VMCRSTsO 

C RESET FLAG USED IN DECEL WHEN FAST STOP MUST BE MADE 
WATRSTsO 

C PASSENGER WAIT REG RESET FLG, IsRESET 
XCOUNTs5 

C MAX # "COUNT" CAN REACH, THEN EMERGENCY ACTION. USED IN SUBR TACHRD 
YCOUNTs5 

C MAX if "COUNT2" CAN REACH, THEN EMERGENCY ACTION. USED IN SUBR TACHRD 
RETURN 
END 
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TACHRD [H].... TACHOMETER READING SUBROUTINE 
(REVISED 8/11/80) (COMMENTS ADDED 9/16/80) 


THIS SUBR READS AND COMPARES DIGITAL TACH’S. 

IP THE DIGITAL TACH'S DONT AGREE (W/IN TOLERANCE) WITH ONE ANOTHER 
AN EMERGENCY STOP FLAG IS SET. 

SUBROUTINE TACHRD 

LOGICAL BADRD, BRAKES .COUNT , C0UNT2 .DSTRST , EMSTOP , PASTOP , 

•FI , F 1 CNT , F 1 L AST , F2 , F2CNT , F2L AST , F3 , F3CNT , F3L AST , 

•F4 ,Fi<CNT .F4LAST ,F5 .F5CNT .F5LAST.F6 ,*F6CNT .F6LAST , 
•F7,F7CNT|F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 
•F10.F10CNT.F10LST, 

•KCNT2 .KCOUNT.KONE ,KTHREE,KTW0,L,L2 .MALTAK, 

•NRMSTP , PLUG , POWER , RBRST.RDY1 . RDY2 , SLOWDN , 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST . WATRST .XCOUNT .YCOUNT 
LOGICAL KBRAKE .KLIVE , KPLUG, KPOWER .LIVE , PLGLST 


INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDL A , DIST, 
•INCACC, INCEM, INCFST , INCNRM, INCR , INCSLO , 

•DISTM.DLA 1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA .INTD.K. L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD . MSB , MSBO , K4CNT, NUMOUT , PLAT1 , 
•PWAIT.RBDIST.SAT1 ,SAT2,SL0PA,SL0PD.TAK1 ,TAK2, 

•TAK3 , TAKOLD , TAKTOL , TPLAT .VELCON .VELERR .VELMAX , VELOC, 
•VMC , VMCOUT , WAITMX , X , Y 


COMMON /L/BADRD, BRAKES, COUNT, C0UNT2, DSTRST, EMSTOP, FASTOP, 
•F 1 , F 1 CNT , FI LAST , F2 .F2CNT , F2LAST.F3 , F3CNT , F3LAST , 
•F4,FJlCNT,FUAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 
•F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 

• •F10.F10CNT.F10LST, 

•KCNT2 .KCOUNT, KONE , KTHREE , KTWO , L , L2 .MALTAK , 

•NRMSTP , PLUG , POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR, TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
COMMON /L 1 /KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD .BRKDLA , DIST, 
•INCACC, INCEM, INCFST , INCNRM, INCR , INCSLO , 

•DISTM.DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB, MAXRBD , MSB, MSBO , K4 CNT, NUMOUT, PLAT1 , 

•PWAIT , RBDIST , 3AT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 , TAKOLD , TAKTOL , TPLAT .VELCON .VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

iiiHmoiiHiimHimiiiiitiiimiiiiitiiiiiimiiiiimm 

FIRST RESET APPROPRIATE COUNTERS 
LREG=0 
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C "LREG"= COUNT UP REGISTER, NUMBER OF TIMES ONLY ONE DIG TAK READY TO READ 
LLREG=0 

C »LLREG"s COUNT UP REG FOR NUMBER OF TIMES BOTH DIG TAKS NOT READY TO READ 

CHIIIHIIIHHIimilllHIIIIIIimilllllHHIIIIHIIHIIIIIHHI 

C CHECK IF TACH READY FLAGS ARE SET ON BOTH DIGITAL TAKS 
C FIRST CLEAR RDY STATUS FLAGS 
600 RDYfeO 
RDY2=0 

C NOW INPUT WORDS CONTAINING STATUS 
L=INP( 16) 

L2=INP(32) 

C READY STATUS APPEARS IN BIT 1} NEXT STATEMENTS DETECT STATUS OF READY 
IF((L.AND.2).EQ.2) RDY1=1 
IF((L2.AND.2).EQ.2) RDY2s1 
C ARE BOTH DIG TACHS READY TO BE READ? 

IF( ( RDY1 . AND. RDY2) . EQ, 1 ) GO TO 640 
C NO? THEN ARE EITHER READY? 

IF( (RDY1 .0R.RDY2) .EQ. 1 ) GO TO 610 
GO TO 630 

C NO? THEN GO COUNT HOW MANY TIMES THAT THIS HAS OCCURED THEN TRY AGAIN 
C NEXT COUNT HOW MANY TIMES ONLY ONE TACH WAS READY TO BE READ 
610 LREGsLREG+1 

IF( LREG. LT. 5000) GO TO 600 

C IF 5000 IS EXCEEDED THEN ONLY ONE DIG TACH IS WORKING 
C SET BAD TAK FLAG FOR PANEL INDICATOR 
TKSLR=3 

C SET EMERGENCY STOP FLAG 
EMSTOP= 1 
RETURN 

C COUNT HOW MANY TIMES NEITHER DIG TACH WAS READY 

630 LLREG=LLREG+1 

C IF THIS COUNT EXCEEDS 5000 BETTER CALL FOR EMERGENCY STOP 
IF( LLREG.LT. 5000) GO TO 600 
C GUESS WE CAN’T READ EITHER DIG TACH! BETTER STOP 
C SET BAD TAK INDIC FLAG AND EMERGENCY STOP FLAG 
TKSLRs3 
EMSTOPsI 
RETURN 

C BOTH DIG TACHS READY TO READ, LETS READ AND COMPARE! 

C BUT FIRST STORE OLD TAK1 VALUE FOR USE IN DETERMINING ACCELERATION 
640 TAK0LD=TAK1 

C FIRST INPUT LOW AND HIGH ORDER WORDS FROM TAK1 BOARD 

LL0W=INP(17) 

LHIGH=INP( 18) 

C NEXT, INPUT LOW AND HIGH ORDER WORDS FROM TAK2 BOARD 
L2L0W=INP(33) 

L2HIGH=INP(34) 

C TAK BOARDS DON’T KNOW FROM 2'S COMPLEMENT!! RESCALE TO INTEGER 
IF(LLOW.LT.O) LL0W=256+LL0W 
IF(L2L0W. LT.O) L2L0W=256+L2L0W 

C NOW COMBINE LOW AND HIGH ORDER WORDS INTO ONE 16 BIT INTEGER 
TAK1=LL0W+256»LHIGH 
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TAK2xL2L0W+256*L2HIGH 

C NEXT CHECK STATUS WORD FOR TACH (VEHICLE) DIRECTION 
C THEN APPLY PROPER SIGN TO TAK VARIABLES 
IF( (L. AND. 1 ) . EQ, 1 ) TAKIs-TAKl 
IF( (L2.AND. 1 ) ,EQ. 1 ) TAK2--TAK2 

C NEXT THO LINES CHECK FOR BOTH DIG TAKS OFF-LINE AND MTR CNTRLR ON 
IF(VMC.LT.SO) GO TO 642 
IF( (TAK1.0R.TAK2).EQ.O) GO TO 644 

C THE FOLLOWING 2 LINES CHECK FOR OUT-OF-LIMITS DIFF BETWEEN DIG TAKS 

642 LDIFFsIABS( TAK1-TAK2) 

IF ( LDIFF.LT. TAKTOL) GO TO 649 
GO TO 643 

644 BADRDsBADRD+2 
GO TO 645 

643 BADRDxBADRD+2 

C NEXT STATB4ENT ALLOWS TAKS TO READ DIFFERENT VALUES FOR 50 TIMES 

645 IF(BADRD.LT.50) GO TO 650 

C IF BADRD>50 SET BAD TAK AND EMERG STOP FLAGS 
641 TKSLR=3 

EMSTOPsI 
RETURN 

C CLEAR BADRD COUNTER 

649 BADRDxO 

650 RETURN 

C ANY ANALOG TACH READ ROUTINE CAN BE PUT BELOW. USE ANTAK.FOR 
END 


CtimimmiiiHimiimiiimiiiHHimimimmiimiiiii 

C 

C CTRLV [8] ESTABLISHES CONTROL VELOCITY 

C 

C (REVISED 7/1 4/80) (COMMENTS ADDED 9/16/80) 

C 

CiiiiimiiiMiiiiiiimiitiHiiiiiMiHiiimiiiiiiHmiimiiif 

SUBROUTINE CTRLV 

LOGICAL BADRD , BRAKES , COUNT ,C0UNT2 ,DSTRST , EMSTOP , FASTOP , 

•PI , F 1 CNT , P 1 I, AST , F2 , F2CNT , F2L AST , F3 , F3CNT , F3L AST, 
•F4,F4CNT,F4MST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 
•F7,P7CNT t F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 
•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT , KONE , KTHREE , KTWO , L , L2 , MALT AK , 

•NRMSTP , PLUG, POWER, RBRST, RDY1 , RDY2 , SLOWDN, 

•TAKRDY ,TKSLR ,TMDSTP ,TRMSTP , VMCRST , WATRST ,XC0UNT , YGOUNT 

LOGICAL KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

CIHIIHIHIIHIIIIIIIIHimiliHlillHIlHIHIHIHIIIHHIli* 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 

•INCAC C , INCEM , INCFST , INCNRM , INCH , INCSLO , 

*DISTM,DLA1 , INPO, INP1 , INP17 , INP2 , INP3 , INP4 , 

•INP9 > INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW ,LSB,MAXRBD ,MSB,MSB0 ,K4CNT, NUMOUT ,PLAT1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAK OLD, TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 
f VMC , VMCOUT, WAITMX , X , Y 

COMMON /L/BADRD, BRAKES, COUNT, C0UNT2 ,DSTRST, EMSTOP, FASTOP, 

•F 1 , F 1 CNT , F 1 LAST ,F2 ,F2CNT , F2L AST , F3 , P3CNT , F3LAST , 

•F4 , F4CNT , F4LAST , F5 ,F5CNT , F5L AST , F6 , F6CNT , F6LAST, 

•F7 ,F7CNT , F7LAST ,F8 ,F8CNT ,F8LAST ,F9 ,F9CNT ,F9LAST , 
•F10,F10CNT,F10LST, 

•KC NT2 , KCOUNT , KONE , KTHREE, KTWO , L , L2 ,MALT AK , 

•NRMSTP , PLUG, POWER, RBRST, RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR,TMDSTP,TRMSTP , VMCRST , WATRST ,XCOUNT ,YCOUNT 

COMMON /L1/KBRAKE, KLIVE, KPLUG, KPOWER, LIVE, PLGLST 

CHHIIIIIIIIIIIIIHIIIIIHIilllllllHIlHIHIIIIIIHfHIIIIIUIl 

C OMMON / 1/ ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 

•INCAC C, INCEM , INCFST , INCNRM , INCR , INCSLO , 

•DISTM , DL A 1 , INPO , INP1 , INP 1 7 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB ,MAXRBD , MSB, MSBO ,K4 CNT , NUMOUT , PLAT1 , 

•PWAIT, RBDIST, SAT1 ,SAT2, SLOPA, SLOPD, TAK1 ,TAK2, 

•TAK3 , TAK OLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

CiitiiiiiiiiiiiiiiiiHmiiiimHmifiimmmimiiiiiimi 

CHitfHiHiifiHiiiiiikiiiHiMiiiiiiiiiiHiHimimmmHi 

C EITHER FASTOP OR NRMSTP MUST BE SET TO COMMAND VELOCITY sO 
IF(( FASTOP. OR. NRMSTP). NE.1) GOTO 910 

905 VELC0N=0 
RETURN 

C TRMSTP INDICATES ROADSTOP (MAGNET) MUST MAKE TWO-STAGE MEASURED TYPE 
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C STOP 

910 IF(TRMSTP.NE.I) GO TO 930 
C CONTROL VELOCITY OF 620 * 2 MPH 
VELC0N.620 

C MAKE SURE STOPPING DISTANCE COUNTER IS ZERO'D AT BEGINNING OF STOP 
IF(DSTRST.EQ.I) GO TO 920 
DSTRSTxl 
DISTsO 

C MUST SCALE DOWN DIST TO REMAIN BELOW 32 ,768 
C TAK1 UNSCALED * 10,500 CTS/FT 

C DISTM IS MAXIMUM DIST ALLOWED PAST MAGNET THEN STOP IS COMMANDED 
920 IF ( DIST • GE . DISTM) GO TO 905 

DIST=DIST+( TAK1/ 8) 

RETURN 

930 DSTRSTsO 

IF(TMDSTP.EQ.I) GO TO 905 
IF(SLOWDN.NE.I) GO TO 940 

C SLOWDNsI FOR PRIM SENS AND TURNING INDIC; 2 MPH= 620 
VELCONs620 
RETURN 

C STATEMENTS BELOW USED FOR TWO STAGE ACCEL. FROM STOP 
C VEHICLE MUST ATTAIN AT LEAST 1.75 MPH BEFORE PLATEAU TIME PERIOD STARTS 
940 IF( TPLAT. GT. PLAT1 ) GO TO 950 

IF(TAK1 .LT.550) GO TO 942 

TPLAT=TPLAT+1 
942 VELC0N=620 

RETURN 

C CONTROL VELOCITY OF 2000 s 6.8 MPH 
950 VELCONs2000 

RETURN 
END 


page is 
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SUBROUTINE FLGSET [5].. SETS FLAGS BASED ON TTL INPUTS 
(REVISED 7/31/80) (COMMENTS ADDED 9/18/80) 


SUBROUTINE FLGSET 

LOGICAL BAD RD, BRAKES, COUNT , COUNT 2 ,DSTRST, EMSTOP ,FAST0P , 
*F1 ,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 

•FiJ ,F1<CNT,F1|LAST,F5,F5CNT,F5LAST,F6 ,F6CNT,F6LAST, 

•F? , F7CNT , F7L AST ,F8 , F80NT ,F8L AST , F9 , F9CNT ,F9L AST , 
•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT , KONE , KTHREE , KTWO , L , L2 ,MALTAK , 

* NRMSTP , PLUG, POWER , RBRST, RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
LOGICAL KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

llllilllllllllHIIIIIIIIIIIIIIIIIIIIIIIIIHIKIIIIIIIIII 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA, DIST , 
•INCACC , INCEM , INCFST , INCN IW , INCR , INCSLO , 

•PISTM,DLA1 ,INP0,INP1 ,INP17,INP2,INP3,INPJ» , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB, MSBO , KUCNT, NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 ,SAT2,SL0PA,SL0PD,TAK1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 
•VMC , VMCOUT , WAITMX , X , Y 


COMMON /L/BADRD, BRAKES, COUNT, C0UNT2 ,DSTRST, EMSTOP, FASTOP, 
•FI ,F1 CNT ,F1LAST,F2 ,F2CNT ,F2LACT ,F3 ,F3CNT ,F3LAST , 

•FA ,FACNT,FALAST,F5,F5CNT,F5LAST,F6 ,F6CNT,F6LAST, 

•F7 ,F7CNT ,F7LAST ,F8 ,F8CNT ,F8LAST ,F9 ,F9CNT ,F9LAST , 
•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT, KONE , KTHREE, KTWO, L, L2 ,MALTAK, 

•NRMSTP , PLUG, POWER , RBRST, RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
COMMON /LI /KBRAKE , KLIVE, KPLUG, KPOWER , LIVE , PLGLST 


COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX, ACCOLD , BRKDLA , DIST , 
•INCACC , INCEM , INCFST , INCN RM , INCR , INCSLO , 

•DISTM,DLA1 ,INP0,INP1 ,INP17,INP2,INP3,INPA, 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB, MAXRBD , MSB, MSBO , K4CNT, NUMOUT, PLAT1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 


THE FOLLOWING 8 LINES OF CODE TOGGLE ON AND OFF THE SECONDARY 
SENSOR FLAG ONLY AFTER 5 CONSECUTIVE O'S OR 1'S HAVE BEEN DETECTED. 
IF(FA.NE.FALAST) GO TO J»25 
F1»CNT=0 
FALASTsFA 
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430 F4*F4LAST 

GO TO 435 

425 F4CNT«F4CNT+1 

IF(F4CNT.LT,5) GO TO 430 
F4LAST#F4 

C THE FOLLOWING 6 LINES OF CODE TOGGLE ON AND OFF THE EMERG. STOP 
C PUSH BUTTON FLAG ONLY AFTER 5 CONSECUTIVE O'S OR 1*8 HAVE BEEN DETECTED 
435 IF(P1 .NE.F1LAST) GO TO 470 

FICNTsO 
FILASTsFI 
472 FIsFILAST 

GO TO 474 

470 F1CNTcF1CNT+1 

IF(F 1CNT.LT. 5) GO TO 472 
FILASTsFI 

C THE FOLLOWING 8 LINES OF CODE TOGGLE ON AND OFF THE BUMPER SWITCH 

C FLAG ONLY AFTER 5 CONSECUTIVE 0*S OR 1»S HAVE BEEN DETECTED. 

474 IF ( F2 • NE . F2L AST ) GO TO 480 

F2CNTbO 
F2LASTsF2 
482 F2sF2LAST 

GO TO 484 

480 F2CNTsF2CNT+1 

IF(F2CNT,LT.5) GO TO 482 
F2LAST=F2 

C CALL FOR EMERG. STOP IF PANIC BUTTON OR BUMPER SW. ARE HIT 
484 IF((F1.0R.F2).EQ.1) CALL EMSTPR 

C THE FOLLOWING 8 LINES OF CODE TOGGLE ON AND OFF THE PRIMARY 

C SENSOR FLAG ONLY AFTER 5 CONSECUTIVE O'S OR 1 * S HAVE BEEN DETECTED. 

IF(F3.NE.F3LAST) GO TO 440 
F3CNT=0 
F3LASTsF3 
442 F3sF3LAST 

GO TO 444 

440 F3CNTsF3CNT+1 

IF( F3CNT.LT. 5) GO TO 442 
F3LASTsF3 

C THE FOLLOWING 11 LINES OF CODE TOGGLE ON THE STRG* ANGLE INDIC. 

C FLAG ONLY AFTER 5 CONSECUTIVE 1'S HAVE BEEN DETECTED. 

C THIS FLAG CAN BE TURNED OFF ONLY AFTER 50 CONSEQUTIVE O'S ARE DETECTED. 
444 IF(F8. NE.F8LAST) GO TO 450 

FSCNTsO 
F8LAST&F8 

452 F8=F8LAST 
GO TO 408 

450 IF(F8.EQ.O) GO TO 451 
F8CNT=F8CNT-f20 

GO TO 453 

451 FSCNTsweCNT+P 

453 IF( F8CNT . LT. 1 00) GO TO 452 

F8LAST=F8 

C IF PRIM. OR STRG. ANGLE FLAG IS ON GO SET SLOWDN FLAG»1 


B— 17 




408 IF((F3.0R.F8),EQ.1) GO TO 405 

SLOWDNsO 
GO TO 407 
405 SLOWDNsI 

407 CONTINUE 

C THE FOLLOWING 8 LINES OF CODE TOGGLE ON AND OFF THE LOSS OF WIRE 
C FLAG ONLY AFTER 5 CONSECUTIVE O'S OR 1*S HAVE BEEN DETECTED. 
IF(F7.NE.F7LAST) GO TO 460 
F7CNT*0 
F7LAST.F7 
462 F7 sF7LAST 

GO TO 410 

460 F7CNTrF7CNT4-1 

IF(F7CNT.LT.5) GO TO 462 
F7LAST«F7 

C IF LOSS OF WIRE OR SEC, ARE ON GO SET FASTOP FLAGssI , OTHERWISE CLEAR 
C THIS FLAG 

410 IF((F7.0R.F4).EQ.1) GO TO 414 

FASTOPsO 
VMCRSTsO 
KONEsO 
GO TO 415 

C THE FOLLOWING TMDSTP FLAG CAN ONLY BE CLEARED BY COMPLETE STOP 
C AND COMPLETION OF WAIT PERIOD. BOTH TMDSTP ATRMSTP FLAGS 
C CLEARED IN SUBR.TSTOP 

414 FASTOPsI 

C IF BOARDING TAPE SW OR ROAD MARKER ARE ON SET TMDSTP* 1 

415 IF( (F6 . OR. FI 0) . NE. 1 ) GO TO 420 

C TMDSTP* 1 CAUSES VEHICLE TO REMAIN STOPPED FOR PERIOD OF TIME AFTER 
C IT HAS COME TO A STOP, 

TMDSTP* 1 

C TRMSTP* 1 CAUSES ACCURATE TWO STAGE MEASURED DECELERATION 
C TO CORRECT STREET LOCATION 
IF(FIO.EQ.I) TRMSTP *1 
4,20 RETURN 

C FLAGS F5 AND F9 HAVE BEEN REMOVED UNTIL CONNECTED ON VH1ICLE 
END 


oooo o o o oooooooo 
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SUBROUTINE HLDSTL [ 14 ] . . . . USED TO HOLD VEHICLE STATIONARY USING MTR 

AND TO BRING TO STOP USING MTR DURING EMERG. 


(REVISED 7/31/80) (COMMENTS ADDED 9/18/80) 


SUBROUTINE HLDSTL 

LOGICAL BADRD, BRAKES, COUNT, COUNTS ,DSTRST, EMSTOP ,FAST0P, 
•F1,P1CNT,F1LAST,F2,P2CNT,F2LAST,F3,F3CNT,F3LAST, 

•F4 , F 4CNT , F 4L AST , F5 ,F5CNT , F5L AST , F6 , F6 CNT , F6L AST , 

•F7 , F7CNT , F7LAST , F8 , F8CNT , F8L AST , F9 , F9CNT , F9L AST , 

•F 1 0 , F 1 0CNT , F 1 OLST , 

•KCNT2 , KCOUNT , KONE , KTHREE ,KTW0 , L, L2 ,MALTAK, 

•NRMSTP,PLUG, POWER, RBRST, RDY1 , RDY2 , SLOWDN, 

•TAKRDY, TKSLR, TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
LOGICAL KBRAKE,KLIVE,KPLUG,KPOWER,LIVE,PLGLST 

iiiiimiMiiiimimiiiiHiiiiiiiiiiiiHHiiiiiiismmi 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC , INCEM, INCFST , INCNIH , INCR , INCSLO , 

•DISTM,DLA1 , INPO, INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB , MAXRBD , MSB, MSBO , K4CNT, NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAK OLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

• VMC , VMCOUT , WAITMX , X , Y 

COMMON /L/BADRD, BRAKES, COUNT, C0UNT2 ,DSTRST, EMSTOP, FASTOP, 
•F 1 , F 1 CNT , F 1 LAST, F2 ,F2CNT , F2LAST , F3 ,F3CNT , F3LAST , 

*F4 , F4CNT , F4L AST,F5 , F5CNT, F5L AST , F6 , F6CNT, F6L AST , 

•F7 , F7CNT , F7LAST , F8 , F8CNT , F8LAST , F 9 , F 9CNT , F9LAST , 

*F 1 0 , F 1 OCNT , F 1 OLST , 

•KCNT2 , KCOUNT, KONE, KTHREE, KTWO, L, L2 ,MALTAK , 

*NRMSTP,PLUG, POWER, RBRST, RDY1 , RDY2 , SLOWDN, 

•TAKRDY, TKSLR, TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
COMMON /LI /KBRAKE ,KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

COMMON /I/ ABSTAK, ABSVEL, ACCEL, ACCMAX, ACCOLD, BRKDLA, DIST, 
•INCACC , INCEM, INCFST , INCNRM , INCR , INCSLO , 

•DISTM,DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

• TNP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

%L0W , LSB , MAXRBD , MSB , MSBO , K4 CNT , NUMOUT , PL ATI , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAK OLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX ,X,Y 

•HimmmmiHiiimiiifmiHHtiiMiiifimiHHiiM 


THIS SUBR. DOES NOT TRY TO CONTROL ACCEL. OR JERK 
IF STOPPED RETURN 

IF(TAKI.EQ.O) RETURN 
C CHECK FOR FORWARD OR REVERSE MOTION 
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IF(TAKI.LT.Q) GO TO 710 
C IF DIDN'T BRANCH THEN MUST BE FORWARD MOTION 
C IF ALREADY PLUGGING, JUST INCREMENT UP M/C VOLTS 
IF(PLUG.EQ.1) GO TO 705 

C IF NOT PLUGGING, AND M/C VOLTS ARE HIGH, THEN INCR DOWN 
IF(VMC.GT.I) GO TO 703 
C NOTE: PLUGs 1 MEANS TO PLUGII 

C VMC IS SMALL ENOUGH TO TURN OFF AND CALL FOR PLUGGING 
VMCsO 
PLUGs 1 
RETURN 

C REDUCE FORWARD VELOCITY IN NON-PLUG MODE BY REDUCING MTR CNTRL VOLTS 
C NO ACCEL. OR JERK FEEDBACK USED. 

703 VMCsVMC-INCSLO 

C M/C CONTROL VOLTS RANGE IS 0 TO +5 VOLTS 
IF(VMC.LT.O) VMCsO 
RETURN 

C REDUCE FORWARD VELOCITY IN PLUGGING MODE BY INCREASE MTR CNTRL VOLTS 
C OR.. REDUCE REARWARD VELOCITY IN NON PLUGGING MODE. 

705 VMCsVMC+INCSLO 

C VMCs255 (EQUIVALENT TO 5.0 VOLTS DAC OUTPUT), MAX ALLOWED M/C INPUT 
IF(VMC.GT.255) VMCs255 
RETURN 

C REDUCE VEHICLE REARWARD VELOCITY 
C REMEMBER PLUGsO MEANS NOT PLUGGING 
C BRANCH TO 710 IMPLIES VEHICLE ROLLING BACKWARDS 
C IF NOT PLUGGING JUST INCREASE M/C VOLTS 
710 IF(PLUG.EQ.O) GO TO 705 

C IF PLUGGING MUST FIRST GET M/C VOLTS BACK TO ~ 0 THEN TURN OFF PLUGGING 
IF(VMC.GT.I) GO TO 703 
VMC=0 
PLUGsO 
RETURN 
END 
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SUBROUTINE RUNWAY [93. ...USED TO DETECT "RUNAWAY CONDITIONS 
(REVISED 7/15/80) (COMMENTS ADDED 9/18/80) 


THIS SUBROUTINE DETECTS OVERSPEED OR EXCESS REARWARD MOVEMENT 
AND CALLS FOR APPROPRIATE ACTION. 


SUBROUTINE RUNWAY 

LOGICAL BADRD, BRAKES, COUNT, C0UNT2,DSTRST,EMST0P,FAST0P, 

•F 1 , F 1 CNT , F 1 LAST, F2 , F2CNT, F2L AST , F3 , F3CNT , F3L AST, 

•F4 , F4CNT , F4LAST , F5 , F5CNT , F5L AST , F6 ,F6CNT , F6LAST , 
•F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 

*F 1 0 , F 1 OCNT , F 1 OLST , 

•KCNT2 , KCOUNT , KONE , KTHREE , KTWO , L,L2,MALTAK, 

•NRMSTP , PLUG, POWER , RBRST, RDYi , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCR ST, WATRST , XCOUNT , YCOUNT 

LOGICAL KBRAKE ,KLIVE , KPLUG, KPOWER ,LIVE , PLGLST 

iimiimiHimimiiiiimiHHiimiiiiiiiimmiimiiii 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD ,BRKDLA , DIST , 
•INCACC , INCEM, INCFST ,INCNRM , INCR ,INCSLO , 

•DISTM.DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB ,MAXRBD , MSB , MSBO , K4CN! , NUMOUT , PLAT1 , 

•PWAIT , RBDIST ,SAT1 ,SAT2,SLOPA,SLOPD,TAK1 ,TAK2, 

•TAK3 , TAKOLD , TAKTOL , TPLAT , VELCON ,VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

imiKOlllllHIHIHimHlIIIHfilHIIIVIIIIIIIIIIIIIHIIMI 

COMMON /L/BADRD, BRAKES, COUNT, C0UNT2 ,DSTRST,EMSTOP,FASTOP, 
•F1,F-iC.NT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 
*F1*,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 
•F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 

•F10, FI OCNT, FI OLST, 

•KCNT2 , XCOUNT, KONE , KTHREE, KTWO, L,L2 ,MALTAK, 

•NRMSTP , PLUG, POWER , RBRST, RDYI , RDY2 , SLOWDN, 

•TAKRDY , TKSLR , TMDSTP , TRMSTP, VMCRST , WATRST , XCOUNT , YCOUNT 

COMMON /LI /KBRAKE , KLIVE , KPLUG , KPOWER , LIVE , PLGLST 

COMMON /I/ ABST AK , ABSVEL , ACCEL , ACCMAX , ACCOLD ,BRKDLA , DIST, 
•INCACC , INCEM , INCFST , INCNRM , INCR , INCSLO , 

•DISTM , DLA 1 , INPO , INP 1 , INP 1 7 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB ,MAXRBD , MSB, MSBO , K4CNT, NUMOUT , PLAT1 , 

•PWAIT, RBDIST, SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 , TAK OLD , TAKTOL , TPLAT , VEL C ON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT, WAITMX, X,Y 

iHiiiiiiHiifiiMifiiiiiiiiiiiMiimmiiimHmHiiiiiHi 

FIRST CHECK FOR BACKWARDS VELOCITY 

THEN, CHECK ROLLBACK DISTANCE 
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IF(TAKl.GE.O) go TO 1050 

C RBRST IS A REGISTER RESET FLAG FOR RBDIST REGISTER 
IF(RBRST.EQ.I) GO TO 1020 
RBRSTsI 
RBDISTsO 

C TAK1 DIVIDED BY 8 BECAUSE OF ACTUAL 10,500 CTS/FT. MAXRBD IS ALSO SCALED BY 8 
C SUM SCALED TAK COUNTS FOR TOTAL ROLLED BACK DIST. 

1020 RBDISTs RBDIST- ( TAK 1/8) 

IF( RBDIST. GT.MAXRBD) GO TO 1060 
RETURN 
1050 RBRSTsO 

C BOTH DIGITAL TAKS MUST BE OUT OF SAFE SPEED RANGE FOR EMERG. STOP 
IF( (TAK1 .LT.VELMAX). AND.(TAK1 .GT.-VELMAX) ) GO TO 1065 
C NEXT STATEMENT TEMPORARILY DISCARDED UNTIL BIG TACHRD ROUTINE IS UP 
IF((TAK2. LT.VELMAX). AND. ( TAK2. GT.-VELMAX) ) GO TO 1065 
1060 CALL EMSTPR 
EMSTOPs 1 
1065 RETURN 

END 
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SUBROUTINE TSTOP [12] TIMED STOP ROUTINE USED TO TIME STOP PERIOD, 

APPLY HYDRAULIC BRAKES, AND USE MTR TO HOLD 
VEHICLE STATIONARY IN CASE OF BRAKE FAILURE 

(REVISED 7/31/80) (COMMENTS ADDED 9/18/80) 


SUBROUTINE TSTOP 

LOGICAL BAD RD, BRAKES, COUNT, C0UNT2,DSTRST,EMST0P,FAST0P, 
•F1,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 

•F7 , F7CNT , F7L AST , F8 , F8CNT , F8LAST , F9 , F9CNT , F9L AST , 

*F 1 0 , F 1 OCNT , F 1 OLST , 

•KC NT2 , KC OU NT , KONE , KTH REE , KTWO , L , L2 , M ALT AK , 

•NRMSTP , PLUG, POWER , RBRST, RDY1 , BDY2 , SLOWDN , 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
LOGICAL KB RAKE , KLIVE , KPLUG , KPOWER , L IVE , PLGLST 


INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC, INCEM , INCFST , INCNRM , INCR , INCSLO , 

*DISTM,DLA1 , INPO , INP1 , INP17 , INP2 , INP3 , INP4 , 

«INP9, INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB, MSBO , K4CNT , NUMOUT , PL ATI , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAK OLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 
•VMC , VMCOUT , WAITMX , X , Y 


COMMON / L/BADRD , BRAKES , COUNT, C0UNT2 , DSTRST , EMSTOP , F iiSTOP , 
•F 1 , F 1 CNT , F 1 L AST , F2 , F2CNT , F2LAST , F3 , F3CNT , F 3LAST , 

•F4 , F4CNT , F4L AST , F5 , F5CNT , F5LAST , F6 , F6CNT , F6L AST , 
•F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LA$T, 

•F 10, FI OCNT, FI OLST, 

•KCNT2 ,KCOUNT , KONE ,KTHREE, KTWO, L, L2 ,MALTAK , 

•NRMSTP , PLUG , POWER , RBRST, RDY1 , RDY2 , SLOWDN* 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT, YCOUNT 

COMMON /LI /KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX, ACCOLD , BRKDLA, DIST, 
•INCACC , INCEM , INCFST , INCNRM , INCR , INCSLO , 

»DISTM,DLA1 , INPO , INP1 , INP17, INP2 , INP3 , INP4 , 

•INP9 ,INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB, MSBO, K4CNT, NUMOUT , PLAT1 , 

•PWAIT, RBDIST, SAT1 ,SAT2, SLOPA, SLOPD, TAK1 ,TAK2, 

•TAK3 , TAK OLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 


••«•«•*«•««««••••««•••••«««••••*••«•*«••••••••••«•••••••••••«• 

VEHICLE SHOULD BE STOPPED BEFORE ENTERING THIS ROUTINE 
FIRST, APPLY HYDRAULIC BRAKES (KEEP A STOPPED VEHICLE STOPPED!) 
BRAKESs 1» OPEN HYDRAULIC VALVE; BRAKES=i>» TURN ON BRAKE LT; 
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C BRAKES*1|» BRAKE LT INDIC LIGHT; BRAKESs8» EM STOP INDIC LT; 

C BRAKES: 1 6 >> HORN ON;:::: NUMBERS ADD FOR VARIOUS COMBINATIONS 
C OF FUNCTIONS 

IF ( BRAKES . EQ . 23 ) GO TO 1305 
BRAKES=7 

1305 CALL OUT( 5 f BRAKES) 

C MAKE SURE VEHICLE IS NOT MOVING APPRECIABLY ♦/- X IS VELOCITY TOLERANCE 
C IF IT’S MOVING THEN USE MOTOR TO STOP 

IF( (TAK1 .LT.X) «AND.(TAK1 .GT.-X) ) GO TO 1320 
CALL HLDSTL 
1307 KTWOs 3 

C KTWOs 3 INSURES RETURN TO THIS SUBR FROM MAIN 
RETURN 

C REMAINDER OF SUBR. USED FOR PASSENGER STOP TIMER ETC. 

C CAN NOT PASS THIS POINT UNLESS VEHICLE IS STOPPED I 
C RESET BRAKE DELAY AND PLATEAU TIME COUNTERS FOR NEXT ACCEL. 

1320 BRKDLAsO 
TPLATsO 

IF( TMDSTP • NE . 1 ) GO TO 1322 

C NEXT STATEMENTS INSURE TIMED STOP COUNTER REMAINS SET TO 0 SO 
C LONG AS SOMEONE IS HOLDING TAPE SW CLOSED 
TMDSTP=0 
PWAITsO 
WATRST=1 
GO TO 1307 

1322 IF(WATRST.EQ.I) GO TO 1330 

C F4= SECOND SENSOR; DONT TAKE OFF UNTIL THIS IS CLEARED FOR A WHILE 

1321 IF(F4.EQ. 0) GO TO 1360 

C K4CNT VARIABLE IS USED FOR HORN TOOT TIMING 
K4CNT=0 
GO TO 1307 

1360 K4CNT=K4CNT+1 

IF(K4CNT.LT.5) GO TO 1362 
C STATEMENT BELOW USED TO CONTROL HORN TOOTS 

IF ( ( K4CNT .GT.30). AND. (K4CNT.LT. 35)) GO TO 1362 
BRAKESs7 
GO TO 1364 
1362 BRAKES: 23 

1364 IF(K4CNT.LT.50) GO TO 1307 
1350 GO TO 1340 

C PWAIT IS BASIC PASSENGER STOP TIMER 
1330 PWAIT=PWAIT+1 

IF ( PWAIT . GT. WAITMX ) GO TO 1321 
GO TO 1307 

C RESET ALL NECESSARY FLAGS AND REGISTERS BELOW 
1340 WATRSTsO 
K4CNT=0 
PWAIT=0 
TMDSTP=0 
TRMSTPsO 
NRMSTPsO 
FASTOPsO 


VMCRSTsO 

KONEsO 

KTWOsO 

VMC=0 

PLUGsO 

DSTRSTsO 

RETURN 

END 
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SUBROUTINE AC CEL R [10].... USED TO CONTROL ACCELERATION 
(REVISED 7/31/80) (ADDED COMMENTS 9/18/80) 

SUBROUTINE ACCELR 

LOGICAL BAD RD, BRAKES , COUNT , C0UNT2 ,DSTRST , EMSTOP , FASTOP , 
•FI , F 1 CNT , F 1 LAST , F2 , F2CNT , F2L AST , F3 , F3CNT , F3L AST , 
•F4,F4CNT,F4LAST,F5 } F5CNT,F5LAST,F6,F6CNT,F6LAST, 

»F7 , F7CNT, F7L AST , F8 , F8CNT , F8LAST , F9 , F9CNT , F9L AST , 

•F 1 0 , F 1 0CNT t F 1 0LST , 

*KC NT2 , KCOUNT , KONE , KTHREE , KTWO , L, L2 ,MALT AK , 

•NRMSTP , PLUG , POWER , RBRST, RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR, TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 
LOGICAL KBRAKE,KLIVE,KPLUG,KPOWER,LIVE,PLGLST 


INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC, INCEM , INCF ST , INCN RM , INCR , INCSLO , 

•DISTM,DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA,INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K4CNT, NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 

» VMC , VMCOUT , WAITMX , X , Y 

COMMON /L/BADRD , BRAKES, COUNT, C0UNT2 , DSTRST , EMSTOP , FASTOP , 
•F 1 , F 1 CNT * F 1 LAST , F2 , F2CNT , F2LAST , F3 , F3CNT , F3LAST , 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 
«F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 
•F10,F10CNT,F10LST, 

•KCNT2 ,KCOUNT,KONE , KTHREE ,KTW0 ,L,L2 ,MALTAK , 

•NRMSTP , PLUG, POWER , RBRST, RDY1 , RDY2 , SLOWDN , 

•TAKRDY, TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT , YCOUNT 

COMMON /L1/KBRAKF,,KLIVE , KPLUG,KPOWER ,LIVE , PLGLST 


COMMON /I/ABSTAK , ABSVEL, ACCEL, ACCMAX, ACCOLD , BRKDLA, DIST, 
•INCACC , INCEM , INCF ST , INCNRM , INCR , INCSLO , 

•DISTM , DLA1 , INPO , INP1 , INP 1 7 , INP2 , INP3 , INP4 , 

•INP9 , INTA, INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSB 0 , K4 CNT , NUMOUT , PLAT 1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SLOPA , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 


NOTE: PLUG=0 MEANS NOT PLUGGING! I 
IF(PLUG.EQ.O) GO TO 1110 
C IF PLUGGING AT GREATER THAN (36/255) *5.0 VOLTS THEN MUST FIRST DECREMENT 
C OTHERWISE JUST BACK OFF M/C VOLTS TO 0 AND STOP PLUGGING 
IF(VMC.GT.36) GO TO 1150 


RIGINAL PAGE IS 

? POOR QU.AMTY 









VMCsO 
PLUGs 0 
RETURN 

C FIND ACCMAX ON LINEAR CURVE CORRESPONDING TO VELOC ERROR 
1110 ACCMAXs INTA+VELERR*SLOPA 

C MAKE SURE ACCMAX IS NOT ABOVE MAX. ALLOWED LEVEL 
IF( ACCMAX. LE.SAT1) GO TO 1120 
ACCMAXsSATI 

C CHECK THAT ACTUAL ACCELERATION IS LESS THAN ACCMAX 
1120 IF( ACCEL. GT. ACCMAX) GO TO 1130 

C IF ACCEL HAS NOT EXCEEDED ACCMAX THEN CONTINUE TO INCREASE M/C VOLTS 
C OTHERWISE GO TO 1130 AND DECREASE M/C VOLTS 
VMCsVMC+INCACC 

C VMC RANGE MUST REMAIN 0-255 (0 TO 5.0 VOLTS) 

IF( VMC. GT. 255) VMCs255 

C STATEMENTS BELOW USED TO HOLD HYDR. BRAKES ON FOR A LITTLE WHILE 
C WHEN STARTING UP TO PREVENT ROLLBACK ON HILLS 
IF( BRKDLA. GT.DLA1 ) GO TO 1140 
BRKDLAsBRKDLA+1 
RETURN 

C BRAKESsO > RELEASE BRAKES 
1140 BRAKESsO 
RETURN 

1130 VMCsVMC-INCACC 
GO TO 1151 

C NOTE: MUST RETURN VMC TO 0 IF YOU ARE CURRENTLY PLUGGING BUT WANT 
C TO ACCELERATE. 

C 1150 USED TO BACK OFF M/C VOLTS FAST IN ORDER TO STOP PLUGGING AND 
C BEGIN ACCELERATION 

1150 VMCsVMC-INCFST 

C VMC RANGE MUST REMAIN 0-255 (0 TO 5.0 VOLTS) 

1151 IF( VMC.LT.O) VMCsO 
RETURN 

END 
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c 

C SUBROUTINE DECEL [11],.... USED TO CONTROL ACTIVE (PLUGINO) AND PASSIVE 

C DECELERATION. 

C 

C (REVISED 8/20/80) (ADDED COMMENTS 9/18/80) 

C 

ClIillllilllllllllllHMMIfillllllHIIIIIIIIIIIIHIilllNHHHHIlH 

SUBROUTINE DECEL 

LOGICAL BADRD , BRAKES , COUNT, COUNT 2 ,DSTRST , EMSTOP , FASTOP , 
•F1,F1CNT,F1LAST,F2,F2CNT,F2LAST,F3,F3CNT,F3LAST, 
•F4,F4CNT,F4LAST,F5,F5CNT,F5LAST,F6,F6CNT,F6LAST, 

•F7 , F7CNT , F7L AST , F8 , F8CNT , F8LAST , F9 , F9CNT ,F9LAST , 

•F 1 0 , F 1 OCNT , F 1 OLST , 

•KCNT2 , KCOUNT , KONE , KTHREE, KTWO, L, L2 ,MALTAK , 

•NRMSTP , PLUG , POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOU NT , YCOU NT 

LOGICAL KBRAKE , KLIVE , KPLUG, KPOWER , LIVE, PLGLST 

ClllllfllHIlHlIIIIIIIIIIIIIHHIIIIIHIIIIIIIIIHIHIflHlHI* 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA, DIST , 

•INCACC , INCEM , INCFST , INCNRM , INCR , INCSLO , 

•DISTM , DLA1 , INPO , INP 1 , INP 1 7 , INP2 , INP3 , IMP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF, LHIGH , 
tLLOW , LSB ,MAXRBD, MSB , MSBO , K4CNT, NUMOUT , PLAT1 , 

•PWAIT, RBDIST , SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

»TAK3 , TAKOLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

CHmiHMiiitHifmiiiimHHiHiMHivinomimHmiH* 

COMMON / L/BADRD , BRAKES , COUNT, C0UNT2 , DSTRST , EMSTOP , FASTOP , 

•F 1 , F 1 CNT , F 1 LAST , F2 , F2CNT , F2LAST , F3 , F3CNT , F3LAST , 

«F4 , F4CNT , F4L AST , F5 , F5CNT , F5L AST, F6 , F6CNT , F6L AST , 

«F7 , F7CNT , F7LAST , F8 ,F8CNT , F8LAST , F9 ,F9CNT , F9LAST , 

•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT , KONE , KTHREE , KTWO , L , L2 , MALT AK , 

•NRMSTP , PLUG , POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOU NT , YCOU NT 

COMMON / L 1 /KBRAKE , KLIVE , KPLUG, KPOWER , LIVE , PLGLST 

CHiHiiHiiiimiiiiiHHiiliiiiiiiiimimimHiilliiHmH 

COMMON /I/ ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST, 

•INCACC , INCEM , INCFST , INCNRM, INCR , INCSLO , 

•DISTM , DLA1 , INPO , INP1 , INP 1 7 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K4CNT , NUMOUT , PLAT1 , 

•PWAIT, RBDIST, SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 , TAKOLD , TAKTOL , TPLAT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 

C 

C NOTE THAT FASTOPS AT LOW SPEEDS ARE HANDLED DIFFERENTLY THAN AT HIGH SPEEDS 

C IF FASTOP CALLED FOR AND VEHICLE IS GOING "FAST" GO TO 1220 
IF( (TAK1 .LT.900) .AND. ( FASTOP. EQ. 1 ) ) GO TO 1220 

C IF FASTOP CALLED FOR AND VEHICLE IS TRAVELLING "SLOW GO TO 1200 
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IF(FASTOP.EQ.I) GO TO 1200 

C VMCRST AND KONE INSURE THAT ONCE SPECIAL FASTOP DECEL ROUTINE HAS 
C BEEN INVOKED IT IS FOLLOWED THROUGH AS LONG AS FASTOP FLAGs 1 
KONEsO 

IF( ( TMDSTP . OR* SLOWDN) . NE . 1 ) GO TO 1203 
C IF NOT MAKING TMDSTOP OR SLOWDN THEN MUST BEGIN PLUGGING ASAP IF 
C VEHICLE SPEED>3.75 MPH 

IF(TAK1.LT,1160) GO TO 1203 
GO TO 1221 

C NEXT TWO STATEMENTS MAKE SURE THAT IN THE CASE OF FASTOP UNDERWAY 
C WE DONT RESET VMCsO AGAIN 

1220 IF( VMCRST. EQ.1) GO TO 1201 

1221 IF(KONE.EQ.I) GO TO 1203 

C NEXT FOUR STATEMENTS GET M/C INTO PLUG MODE ASAP IF NOT ALREADY THERE 
IF(PLUG.EQ.I) GO TO 1205 
VMCsO 
KONEs 1 
PLUGs 1 
RETURN 

C LINES OF CODE BELOW SET UP DECEL FOR FAST STOP FROM HIGH SPEEDS 
C FOR DECEL TO 0 SPEED WITHIN 6 FT. DECELs(TAK1/22)««2 

1200 IF( VMCRST .EQ.1) GO TO 1201 
VMCRSTsI 

IF(PLUG.NE.I) VMCsO 
PLUGs 1 

ACCMAXsTAK1/22 
ACCMAXs- ACCMAX*ACCMAX 
RETURN 

C NEXT THREE LINES USED FOR FAST STOP FROM HIGH SPEED ONLY 
C DONT LET DECEL EXCEED LIMIT 

1201 IF ( AC CEL . LT . AC CMAX ) GO TO 1214 

C NEXT LINE REMOVES MOTOR CONTROLLER DEAD-BAND, IN PLUGGING MODE 
IF( VMC.LT. 50) VMCs50 
VMCsVMC+INCFST 
GO TO 1208 

1203 IF(PLUG.EQ.I) GO TO 1205 

C NEXT THREE LINES TRANSITION FROM NON-PLUG TO PLUG FOR LOW VMC 
IF(VMC.GT.IO) GO TO 1210 
C NOTE: PLUGs 1 MEANS PLUGGING 1 1 
VMCsO 
PLUGs 1 
RETURN 

C LINES BETWEEN 1205 AND 1232 SET UP INCH AND MAX DECEL DIFFERENTLY 
C DEPENDING UPON SENSOR INITIATED STOP OR OTHER. ALSO, IF SMALL VELOC 
C ERROR THEN SMALLER INCR IS USED. SAT2s MAXIMUM ALLOWED DECEL VALUE 
C (5376s. 16 G) 

1205 IF((F3, OR. FASTOP). EQ.1) GO TO 1230 

INCRsINCACC 

IF( VELERR.LT. 100) INCRsI 
SAT2s-3000 
GO TO 1232 
INCRsINCNRM 


1230 


SAT2=-5376 

C 1232 CALCULATES MAX ALLOWED DECEL CORRESPONDING TO VELOCITY ERROR 
1232 ACCMAX»INTD+VELERR - SLOPD 

C NEXT STATEMENT MAKES SURE THAT THIS DECEL DOES NOT EXCEED SOME MAX FIXED # 
IF( ACCMAX.LT* SAT2) ACCMAX=SAT2 
C KEEP ACCMAX (MAGNITUDE) BELOW A SATURATION LEVEL 
C NOTE: ACCMAX AND JRKMAX ARE NEGATIVE NUMBERS 
C ACCEL<ACCMAX IMPLIES DECEL IS TOO GREAT 
IF( ACCEL.LT. ACCMAX) GO TO 1215 

C STATEMENTS BETWEEN 1207 AND 1240 ADJUST PLUGING DEAD-BAND ACCORDING TO VELOC 

1207 IF(TAK1 .GT.700) GO TO 1240 

C ELIMINATES MTR CNTRLR DEAD BAND DURING PLUGGING AT LOW SPEEDS 
IF(VMC.LT.32) VMC=32 
GO TO 1209 

C NEXT STATEMENT ELIMINATES DEAD BAND DURING PLUGGING AT HIGH SPEEDS 
1240 IF( VMC.LT.40) VMC=40 

1209 VMCsVMC+INCR 

C VMC MUST REMAIN IN RANGE 0-255 (0 TO 5.0 VOLTS) 

1208 IF( VMC.GT.255) VMCs255 
GO TO 1260 

C NOTE: ACCMAX IS A NEGATIVE NUMBER 

1210 INCRsINCNRM 

C CALCULATE MAX ALLOWED DECEL ASSOCIATED WITH PRESENT VELOCITY ERROR 
ACCMAX=INTD+VELERR*SLOPD 
SAT2=-3000 

IF( ACCMAX. LT.SAT2) ACCMAX=SAT2 
IF( ACCEL.LT. ACCMAX) GO TO 1209 

1214 INCR=INCFST 

1215 VMCaVMC-INCR 

IF( VMC.LT.O) VMC=0 

C 1260 CHECKS IF STOPPED ENOUGH TO GO TO TSTOP SUBR AND USE HYDR BRAKES 
1260 IF( ( VELCON.EQ.O) . AND,(TAK1 .LT.30) ) GOTO 1262 

RETURN 

C IF GOING SLOW ENOUGH, TURN OFF M/C VOLTS AND DONT RETURN HERE 
1262 VMCsO 
KTW0s3 

C KTW0*3 > VEHICLE HAS STOPPED, BRANCH TO SUBR TSTOP VIA MAIN 
RETURN 
END 
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c« 

C« SUBROUTINE DATAIO [33.. USED TO INPUT/OUTFUT TTL, A/D, D/A DATA 

C» 

C« (REVISED 7/14/80) (COMMENTS ADDED 9/18/80) 

Ci 

SUBROUTINE DATAIO 

LOOICAL BADRD, BRAKES , COUNT , C0UNT2 ,DSTRST, EMSTOP , FASTOP , 

•F 1 , F 1 CNT , F 1 LAST , F2 , FRONT , F2L AST , F3 , F3CNT , F3LAST , 

•F4 , F4CNT , F4LAST , F5 , F5CNT , F5LAST , F6 , F6CNT , F6LAST , 

•F7 , F7CNT, F7LAST, F8 , F8CNT , F8L AST ,F9 , F9CNT,F9LAST, 

•F 1 0 , F 1 OCNT , F 1 OLST , 

•KCNT2 , KCOUNT , KONE , KTHREE , KTWO , L , L2 , MALT AK , 

•NRMSTP , PLUG , POWER , RBRST , RDX 1 , RDY2 , SLOWDN , 

•TAKRDX , TKSLR , TMDSTP , TRMSTP , VMCRST , WATR ST , XCOUNT , YCOU NT 
LOGICAL KBRAKB, KLIVE , KPLUG , KPOWER , LIVE , PLOLST 

CHHIIIIIHIIIIIiniHIHIIIIIIIIIIIIIIIIIIllllHHIIIHHIlHI 

INTEGER ABSTAK, ABSVEL , ACCEL, ACCMAX , ACCOLD ,BRKDLA, DIST, 
•INCACC , INCEM , INCF ST , INCNRM , INCR , INCSLO , 

•DISTM,DLA1 ,JNP0,INP1 ,INP17iINP2,INP3,INPl», 

•INP9 , INTA ,INTD , K , L2H1GH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K A CNT , NUMOUT , PL ATI , 

•PWAIT , RBDIST , SAT1 ,SAT2,SL0PA,SL0PD,TAK1 ,TAK2, 

•TAK3 ,TAKOLD , TAKTOL , TPL AT , VELC ON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX, X , Y 

CiiiHmuHiHHHiiiiimmiHiiiiimiiiiiiimiHiHimii 

COMMON /L/BADRD, BRAKES , COUNT , C0UNT2 , DSTRST, EMSTOP , FASTOP , 

»F1 ,F1CNT,F1LAST,F2,F2CNT,F2LAST>F3,F3CNT,F3LAST, 

*Fl| , F4 CNT , FALAST , F5 , F5CNT , F5L AST , F6 , F6 CNT, F6L AST , 

*F7 , F?CNT , F7LAST , F8 , F8CNT , F8L AST , F9 , F9CNT , F9LAST , 
•F10,F10CNT,F10LST, 

•KCNT2 , KCOUNT , KONE , KTHREE, KTWO , L , L2 ,MALTAK , 

•NRMSTP , PLUG, POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOUNT ,YCOU,‘!T 
COMMON /L 1/KBRAKE , KLIVE , KPLUG , KPOWER , LIVE , PLGLST 


COMMON /I/ ABSTAK, ABSVEL, ACCEL , ACCMAX, ACCOLDCR, INCSLO, 
•DISTM,DLA1,INP0,INP1,INP17,INP2,INP3,INP1|, 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MINTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K 1 ! CNT , NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 , SAT2 , SL OP A , SLOPD , TAK 1 , TAK2 , 

•TAK3 , TAKOLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 
•VMC , VMCOUT , WAITMX , X , Y 


NEXT CALL BEGINS *LIVE" PULSE OUT TO PORT 6 
LIVEs 1 

CALL OUTfe .LIVE) 

C TEMPORARILY STIPE EXISTING VALUES OF PLUG, POWER, AND BRAKES 
KPLUGsPLUG 


KPOWER* POWER 
KBRAKExBRAKBS 

C NOW TOGGLE ALL «F" FLAGS OFF 
FI sQ 
F2s0 
F3sO 
F4sO 
F5*0 
F6sG 
F?sO 
F8s0 
F9«0 
FIOsO 

C NEXT ;nput port bytes 
XNPO alNP(O) 

INPtsXNPCI) 

INP2sXNP(2) 

XNP3sXNP<3) 

C IF BIT 0 IN PORT 0 =1, EMERG STOP PB IS ON, SET FLAG FI 
IF( ( INPO . AND , 1 ) . EQ. 1 ) FI si 

C IF BIT 2 IN PORT 0 si BflDG TAPE SW IS ON, SET FLAG F6 
IF( (INPQ. AND.4) .EQ.4) F6s1 

C IF BIT 4 It* PORT 0 el, LOSS OF WIRE INDIC.,SET FLAG F7 
IF ( ( INPQ . AND . 1 6 ) . EQ. 1 6 ) F7 s 1 

C IF BIT 0 IN PORT 1 si, EM ST BMPR SW IS ON, SET FLAG F2 
XF( (INP1 .AND. 1) .EQ. 1) F2s1 

C IF BIT 2 IN PORT 1 si, STRG ANGLE INDIC IS ON, SET FLAG F8 
IF( (INP1 .AND.4) .EQ.4) F8=1 

C IF BIT 4 IN PORT 1 si, ROAD MRKR INDIC. IS ON, SET FLAG FIO 
IF((XNP1.AND.16).EQ.16) FIOsI 

C IF BIT 0 IN PORT 2 si, SEC SENSOR IS ON, SET FLAG FA 
IF( (INP2. AND. 1 ) .EQ. 1 ) F4*1 

C IF BIT 2 IN PORT 2 si , LFT TURN SENSOR IS ON, SET FLAG F5 
IF( (INP2.AND.4) .EQ..A) F5«1 

C IF BIT 0 IN PORT 3 si, PRIMARY SENSOR IS ON, SET FLAG F3 
IF( (INP3. AND. 1 ) .EQ. 1 ) F3=1 

C IF BIT 2 IN PORT 3 =1 , HYDR. SYS. LOW PRESS SW IS ON, SET FLAG F9 
IF( (INP3. AND.4) .EQ.4) F9s1 

C PLUG IS OUTPUT BYTE USED TO LIGHT UP PANEL INDIC LTS; BELOW 

C IF STATEMENTS TURNJON APPROPRIATE LIGHTS 
IF(FI.EQ.I) PLUGs PLUG+2 
IF(F6.EQ. 1 ) PLUGsPLUG+ 4 
IF(F7.EQ.1) PLUGsPLUG+8 
IF ( F2 . EQ. 1 ) PLUGsPLUG+16 
IF(F8.EQ,1) PLUGs PLUG-f 32 
IF(FIO.EQ.I) PLUGsPLUG+64 
IF(F4.EQ.1 ) PLUGsPLUG+128 

C HER LIVE OUTPUT BYTE IS USED TO TURN ON INDIC LT IF SEC SENS IS ON 
IF(F4.EQ.1) LIVE=3 

C STATEMENT FROM HERE TO 310 TURN ON OR OFF: BRAKE VALVE, STOP LT, STOP LT 

C INDIC., OR HORN DEPENDING UPON NEED. (SEE COMMENTS AT BEGINNXGN OF SUBR 

C TSTOP FOR "BRAKES" BREAKDOWN) 
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IF( (KBRAKE.EQ.7) ,OR.(KBRAKE.EQ.23) ) GO TO 310 
IF((NRMSTP.OR.EMSTOP.OR.FASTOP.OR.SLOWDN) .EQ.1) BRAKESsfi 
IF(THDSTP.EQ.I) BRAKESs6 

C NEXT CALL USED TO CONTROL HYDRAULIC BRAKES (VALVE) 

310 CALL OUT( 5, BRAKES) 

C NEXT CALL CONTROLS MAIN POWER RELAY AND TURNS ON PANEL INDIC LT FOR PRI SENS 
IF(F3.EQ.1) POWERs POWER+2 
CALL 0UT(7, POWER) 

C NEXT EXPRESSION CAN BE USED TO SCALE MTR CNTRL VOLTAGE PRIOR TO OUTPUT 
VMCOHTsVMC 

C BELOW, ROUTINE MAKES SURE THAT VMCOUTsO BEFORE PLUG CHANGES VALUE II! 
IF(KPLUG.NE.PLGLST) GO TO 320 

C NEXT CALL USED TO PLACE MTR CNTRL VOLT IN RAM FOR DAC 
CALL POKE(-1,VMCOUT) 

C NEXT CALL TO PORT 5 USED TO CONTROL MTR CNTRL R FOR/REV 
CALL 0UT(4,PLUG) 

GO TO 330 

320 VMCOUTsO 

CALL P0KE(-1 ,VMCOUT) 

C NEXT CALL ENDS "LIVE" PULSE AT OUTPUT PORT 7 

330 LIVEsO 

CALL 0UT(6,LIVE) 

C NOW THAT PLUG, POWER, BRAKE HAVE BEEN PROSTITUTED TO OUTPUT INDIC LT 

C INFORMATION, CHANGE THEM BACK TO VALUES STORED AT ENTRY TO THIS SUBR 
PLUGsKPLUG 
POWERsKPOWER 
BRAKESsKBRAKE 
PLGLSTsPLUG 
RETURN 
END 
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SUBROUTINE EMSTPR [15].. USED FOR EMERGENCY STOPS 

IMPORTANT: THIS SUBR DOES NOT RETURN, IT IS A DEAD END I! 
(REVISED 7/ 14/ 80) (COMMENTS ADDED 9/18/80) 


THIS SUBROUTINE AS SPECIFIED BY AL JOHNSTON 
SUBROUTINE EMSTPR 

LOGICAL BADRD , BRAKES , COUNT , C0UNT2 ,DSTRST , EMSTOP ,FASTOP , 

•F 1 , F 1 CNT , F 1 L AST , F2 , F2CNT , F2LAST , F3 , F3CNT , F3L AST , 

•F4 , F4CNT , F4LAST , F5 ,F5CNT , F5LAST , F6 , F6CNT , F6LAST , 
•F7,F7CNT,F7LAST,F8,F8CNT,F8LAST,F9,F9CNT,F9LAST, 

•F 1 0 , F 1 OCNT , F 1 OLST , 

•KCNT2 , KCOU NT , KONE , KTH REE , KTWO , L , L2 , MALT AK , 

•NRMSTP , PLUG , POWER , RBRST , RDY1 , RDY2 , SLOWDN , 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOU NT , YCOUNT 
LOGICAL KBRAKE , KLIVE , KPLUG , KPOWER , LIVE , PLGLST 

CHIIIIIIIIIHIIIHIIIIIIIHilllltlllHIIIIIIIIIIIIIIIIHIHHIl 

INTEGER ABSTAK , ABSVEL , ACCEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC , INCEM , INCFST , INCNRM , INCR , INCSLO , 

•DISTM,DLA1 , INPO , INP1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA , INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW , LSB , MAXRBD , MSB , MSBO , K4CNT , NUMOUT , PLAT1 , 

•PWAIT , RBDIST , SAT1 ,SAT2,SL0PA,SLQPD,TAK1 ,TAK2, 

•TAK3 , TAK OLD , TAKTOL , TPL AT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT, WAITMX, X , Y 

COMMON /L/BADRD, BRAKES, COUNT, C0UNT2.DSTRST, EMSTOP, FASTOP, 
•F 1 , F 1 CNT , F 1 LAST ,F2 ,F2CNT , F2LAST , F3 , F3CNT , F3LAST , 

•F4 , F4GNT , F4L AST , F5 , F5CNT , F5L AST , F6 , F6 CNT , F6L AST , 

•F7 , F7CNT , F7LAST , F8 , F8CNT , F8LAST , F9 ,F9CNT , F9LAST , 

•F10 ,F1 OCNT, FI OLST, 

•KCNT2 , KCOUNT , KONE , KTHREE, KTWO ,L,L2 ,MALTAK , 

•NRMSTP, PLUG, POWER, RBRST, RDY1 , RDY2 , SLOWDN, 

•TAKRDY , TKSLR , TMDSTP , TRMSTP , VMCRST , WATRST , XCOU NT , YCOU NT 

COMMON / L 1 /KBRAKE , KLIVE , KPLUG , KPOWER , LIVE , PLGLST 

CiiiiiiiHiiHiHfiHimmimmimmHmHMimHmm 

COMMON / 1/ ABSTAK , ABSVEL , AC CEL , ACCMAX , ACCOLD , BRKDLA , DIST , 
•INCACC , INCEM , INCFST , INCNRM , INCR , INCSLO , 

•DISTM , DLA1 , INPO , INP 1 , INP 17 , INP2 , INP3 , INP4 , 

•INP9 , INTA, INTD , K , L2HIGH , L2L0W , LDIFF , LHIGH , 

•LLOW, LSB, MAXRBD, MSB, MSBO, K4CNT, NUMOUT, PLAT1 , 

•PWAIT, RBDIST, SAT1 ,SAT2 , SLOPA , SLOPD , TAK 1 ,TAK2 , 

•TAK3 , TAKOLD , TAKTOL, TPL AT , VELCON , VELERR , VELMAX , VELOC , 

•VMC , VMCOUT , WAITMX , X , Y 



C THIS SUBROUTINE CYCLES IN AN ENDLESS LOOP DOING THE FOLLOWING: 


C (1) APPLY HYDR. BRAKES, (2) SET VMCsO, (2A) WAIT 30 MSEC, 

C (3) SET PLUGsO, (4) TURN OFF MTR CNTRLR MAIN POWER RELAY, 
C (5) APPLY HYDRAULIC BRAKES, START AT (1) AGAIN 
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CHIIHIiMillHIHIIIHIIIIIIHIIIHIHlHIHHHHIIIHIIIIM 

C FIRST, APPLY HYDRAULIC BRAKES 
500 BRAKES:: 15 

CALL 0UT( 5, BRAKES) 

C NEXT LIGHT UP BAD TAK INDICATOR IF EMSTOP CAUSED BY TAK 
IF(TKSLR.EQ.3) CALL 0UT(6,2) 

C NEXT, SET MOTOR CONTROL VOLTS TO 0 
VMCsO 

VMCOUTbVMC 

C NEXT CALL UOTPUTS VMCOUT FROM DAC 
CALL P0KE(-1 , VMCOUT) 

C THE FOLLOWING DO LOOP JUST INSERTS TIME DELAY TO ALLOW VMC TO REACH ZERO 1 1 
DO 515 Ksl ,1000 
BRAKES=1»15 
CALL OUT( 5, BRAKES) 

515 CONTINUE 

C NOTE: PLUGsO MEANS DONT PLUGIN 

PLUG=0 

CALL OUT (A, PLUG) 

C NEXT TURN OFF MTR CNTRLR POWER COMPLETELY 
POWERs 0 

CALL 0UT(7 .POWER) 

C NEXT TURN ON HYDRAULIC BRAKES AND HOLD IN AN ENDLESS LOOPIIIII 
502 DO 507 Ksl, 5000 

BRAKESs1«15 
CALL OUT( 5, BRAKES) 

507 CONTINUE 

GO TO 500 
END 
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